DYNAMIC  MODELING  OF 
PARALLEL  MANIPULATORS 


-  '  -■ 

By 

IVAN  J.  BAIGES-VALENTIN 


A  DISSERTATION  PRESENTED  TO  THE  GRADUATE  SCHOOL 
OF  THE  UNIVERSITY  OF  FLORIDA  IN  PARTIAL  FULFILLMENT 
OF  THE  REQUIREMENTS  FOR  THE  DEGREE  OF 
DOCTOR  OF  PHILOSOPHY 

UNIVERSITY  OF  FLORIDA 


1996 


Copyright  1995 
by 

Ivan  J.  Baiges- Valentin 


The  author  would  like  to  dedicate  this  work  to  his  parents  Salvador  and  Monsita  Baiges 
and  to  his  brothers  and  sisters  who  supported  and  encouraged  him  all  the  way.  This  work 
is  also  dedicated  to  Zita  Sumaza  whose  friendship  was  a  great  source  of  inspiration  during 
the  most  difficult  moments.  Finally  and  most  important,  this  work  is  dedicated  to  the 
author's  daughter  Gianna  Marie  with  all  his  love. 

This  work  is  dedicated  to  the  memory  of  Prof.  Richard  H.  Zimmerman. 


ACKNOWLEDGEMENTS 

The  author  would  like  to  thank  the  University  of  Florida  and  the  Center  for  Robotics 
and  Intelligent  Machines  for  the  opportunity  of  completing  the  Ph.D.  degree  and  for  the 
financial  support.  The  author  would  like  to  thank  the  Univerity  of  Puerto  Rico  at 
Mayagiiez  and  the  Economic  Development  Agency  of  Puerto  Rico  for  their  support. 

The  author  would  like  to  recognize  the  great  contributions  to  this  work  by  Dr.  Joseph 
Duffy  and  Dr.  Carl  Crane. 

The  author  is  greatly  indebted  to  the  students  and  staff  of  the  Center  for  Robotics  and 
Intelligent  Machines  for  their  help  and  most  importantly  for  their  great  friendship  which 
made  all  this  work  possible. 


iv 


TABLE  OF  CONTENTS 


page 

ACKNOWLEDGMENTS    iv 

ABSTRACT    vii 

CHAPTERS 

1  INTRODUCTION    1 

1.1  Previous    Work   2 

1.2  Objectives    4 

1.3  CAE  Tool  for  Parallel  Manipulators    5 

1.4  Research  Outline    8 

2  SYSTEM  LUMPED  PARAMETER  MODEL    10 

2.1  Energy   Coupling    10 

2.2  Basic  Connector  Model    13 

2.3  Implicit  Force  Control    16 

2.4  Modified  Implicit  Force  Control  Mode    18 

2.5  Combined  High  Frequency  / 

Low  Frequency  Connector  Model    20 

2.6  Connector  Model  for  Dynamic  Modeling    22 

3  PARALLEL  MANIPULATOR  KINEMATICS    24 

3.1  Forward  and  Inverse  Kinematics    24 

3.2  Kinematic  Relationships    25 

3.3  Position   Analysis    27 

3.4  Velocity   Analysis    31 

3.5  Acceleration  Analysis    41 

3.6  Motion   Planning    46 

4  MANIPULATOR  FORCE  AND  TORQUE  ANALYSIS   54 

4.1  Platform  External  Forces  and  Torques    54 

4.2  Gravitational  Forces  and  Torques    61 

4.3  Connector  Forces  and  Torques    62 

4.4  Platform  Resultant  Forces  and  Torques    63 

4.5  System   Singularities    64 

4.6  Connector  Force  Analysis    67 


V 


5  PARALLEL  MANIPULATOR  DYNAMIC  MODELING    75 

5.1  Selection  of  a  Dynamic  Formulation  Method   75 

5.2  Mobility   Analysis    79 

5.3  Generalized  Speeds,  Velocity  and  Acceleration  Analysis   82 

5.4  Velocity  and  Angular  Velocity  Partial  Derivatives   88 

5.5  Setting  up  the  Dynamic  Model    94 

5.6  Deriving  the  Equations  of  Motion    100 

5.7  Dynamic  Model  Validation    117 

5.8  Summary    126 

6  DYNAMIC  SIMULATION  ALGORITHM    128 

6.1  Motion  and  Task  Planning    128 

6.2  Inverse  Kinematic  Simulation  Algorithm    129 

6.3  Equations  of  Motion    133 

6.4  Development  of  the  Dynamic  Simulation  Software   137 

6.5  Dynamic  Simulation  Software    143 

7  TESTING  AND  RESULTS    146 

7.1  System  Geometrical  Description    147 

7.2  System  Parameters    151 

7.3  Motion  and  Task  Planning  for  Testing    154 

7.4  Test  Cases,  Results  and  Discussion    156 

7.5  Summary    186 

8  CONCLUSIONS  AND  RECOMMENDATIONS    192 

8.1  Developing  the  Dynamic  Model    192 

8.2  Dynamic  Behavior  of  Parallel  Manipulators    194 

8.3  Recommendations    195 

8.4  Summary    198 

APPENDIX    200 

REFERENCES    223 

BIOGRAPHICAL  SKETCH    226 


vi         ,  >:  . 


Abstract  of  Dissertation  Presented  to  the  Graduate  School 
of  the  University  of  Florida  in  Partial  Fulfillment  of  the 
Requirements  for  the  Degree  of  Doctor  of  Philosophy 

DYNAMIC  MODELING  OF 
PARALLEL  MANIPULATORS 

By 

IVAN  J.  BAIGES-VALENTIN 
1996 

Chairman:  Dr.  Joseph  Duffy 

Major  Department:  Mechanical  Engineering 

Parallel  manipulators,  which  consist  of  two  rigid  bodies  (a  base  and  a  platform) 
connected  by  six  serial  kinematic  chains  (connectors),  offer  distinct  advantages  when 
compared  to  their  serial  counterparts.  The  motion  of  the  platform  with  respect  to  the  base  is 
controlled  by  the  displacement  of  the  sue  parallel  connectors  which  generate  a  very  stiff  and 
accurate  manipulator  capable  of  handling  high  payloads  with  minimal  positioning  errors. 
These  characteristics  have  generated  great  interest  in  the  use  of  this  type  of  manipulator  in 
applications  such  as  machining  processes  and  automated  assembly  operations. 

It  is  clearly  desirable  to  develop  a  comprehensive  dynamic  model  for  effectively 
designing  and  controlling  the  parallel  manipulators. 

The  major  objective  of  this  research  is  to  derive  explicit  equations  of  motion  for  parallel 
manipulators.  This  will  provide  the  means  to  understand  their  dynamic  behavior  and  enable 
the  design  of  more  efficient  devices  capable  of  fast  and  accurate  motions  while  handling 
heavy  payloads.  As  far  as  the  author  is  aware,  this  is  the  first  time  the  explicit  equations  of 
motion  have  been  derived  (as  opposed  to  numerical  solutions).  They  were  derived  using 
Kane's  Method  which  proved  to  be  well  suited  to  the  intricate  kinematics  of  parallel 
manipulators,  and  verified  with  the  Newton-Euler  formulation.  Subsequently,  the 
equations  were  used  for  a  inverse  dynamic  simulation,  which  calculated  the  actuator  forces 
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required  for  producing  a  desired  motion  of  a  given  design  whilst  supporting  a  workpiece  in 
a  machining  operation.  Various  geometric  parameters,  inertial  properties  and  motion 
profiles  were  used  for  testing  in  order  to  understand  some  of  the  effects  on  the  dynamic 
behavior. 

The  equations  of  motion  indicate  a  high  degree  of  coupling  between  the  connectors 
caused  by  the  gravitational,  tangential,  Coriohs  and  centrifugal  accelerations  acting  upon 
the  system.  A  most  important  result  of  the  inverse  dynamic  simulations  is  that  even  for 
feed  rates  in  excess  of  the  limits  of  existing  technology  (1200  inches  /  min ),  the  only 
significant  coupling  was  due  to  gravity;  the  other  coupling  effects  were  negUgible.  This 
suggests  the  possibiUty  of  using  mass  balancing  to  reduce  the  coupling  effects  between  the 
connectors  and  in  the  process  creating  faster  and  more  accurate  parallel  manipulators. 
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CHAPTER  1 
INTRODUCTION 


Manipulators  or  robots  can  be  classified  according  to  the  type  of  kinematic  chain  used 
for  their  implementation.  Serial  manipulators  are  based  on  open  kinematic  chains  such  as 
the  3  degree-of-freedom  manipulator  shown  on  the  left  hand  side  of  figure  1.1.  Parallel 
manipulators  are  based  on  closed  kinematic  chains  such  as  the  3  degree-of-freedom  system 
shown  on  the  right  hand  side  of  Figure  1.1. 

Saial  manipulators  generally  have  long  reach,  a  great  degree  of  dexterity,  cover  a  large 
workspace  and  can  enter  small  spaces  among  other  advantages.  However,  serial 
manipulators  have  low  stiffness  and  highly  coupled  nonlinear  dynamic  behavior,  specially 
for  high  speed  and  high  payload  applications.  The  main  reason  for  these  limitations  is  the 
that  the  serial  manipulator  is  a  chain  of  cantilever  type  structures,  where  the  compliance  and 
positioning  errors  are  accumulative  effect  of  the  individual  joints. 


Figure  1.1  -  Serial  and  Parallel  Manipulators 


Platform 


Figure  1.2  -  Spatial  Parallel  Manipulator 

In  parallel  manipulators  (see  Figure  1.2)  the  links  act  in  parallel,  generating  a  very  stiff 
and  accurate  manipulator  which  can  carry  a  high  payload  with  minimal  positioning  errors. 
On  the  other  hand,  parallel  manipulators  cover  smaller  work  spaces  and  are  less  dexterous 
than  the  serial  manipulators.  The  particular  nature  of  the  parallel  manipulator  has  generated 
great  interest  in  robotic  applications  where  high  loads  and  precision  are  required  such  as  in 
machining  processes  and  automated  assembly  operations.  The  most  typical  parallel 
manipulator  is  the  Stewart  Platform  [1]  which  consists  of  two  rigid  bodies  connected  by  six 
linear  parallel  actuators.  The  motion  of  one  of  the  rigid  bodies  (namely  the  platform)  with 
respect  to  the  other  (the  base)  is  controlled  by  the  displacement  of  the  six  linear  actuators. 

1.1  Previous  Work 

The  parallel  manipulator  presents  a  different  set  of  problems  than  the  serial 
manipulators.  As  an  example  the  inverse  kinematic  analysis  is  simple  to  determine 
compared  to  the  forward  kinematic  analysis  problem,  which  is  the  opposite  with  serial 
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manipulators.  The  inverse  and  forward  kinematics  of  this  type  of  manipulators  has  been 
studied  [  2, 3, 4]  in  kinematics .  Some  general  design  guidelines  have  been  developed  by 
E.F.  Fichter  [5, 6].  The  inverse  dynamic  analysis  of  the  Stewart  platform  has  been  done 
using  the  Newton-Euler  formulation  [7,  8]  and  the  Lagrange  formulation  [9, 10]. 
Although  in  all  these  cases  the  explicit  equations  of  motion  have  not  been  derived, 
numerical  solutions  have  been  developed  and  used  for  the  dynamic  analysis. 

Control  systems  have  been  developed  and  tested  for  Stewart  platforms  carrying  out 
simple  operations  [  9, 1 1, 12].  In  these  cases  the  dynamic  behavior  has  been  neglected, 
either  by  claiming  that  its  not  significant  or  that  the  error  introduced  by  doing  so  can  be 
corrected  by  the  control  system.  These  assumptions  are  valid  for  slow  motions  and  small 
payloads.  As  the  platform  moves  faster,  the  dynamic  effects  of  the  system  will  become 
more  significant.  For  higher  payloads,  the  links  must  be  stiffer  and  the  actuators  stronger. 
This  will  increase  the  inertial  parameters  which  can  increase  the  dynamic  effects  on  the 
system.  Therefore  designs  and  control  systems  based  on  the  assumption  that  the  dynamic 
behavior  of  the  system  is  not  relevant  are  going  to  be  faulty  and  can  not  be  used 
successfully  in  future  applications. 

The  techniques  developed  up  to  now  in  the  areas  of  dynamics  and  controls  are  adequate 
for  analyzing  existing  manipulators  but  not  adequate  enough  for  designing  platform  based 
manipulators.  In  order  to  design  platforms  with  good  dynamic  performance,  the 
analytical  equations  of  motion  are  required.  These  equations  allow  the  designer  to  examine 
the  effects  of  different  factors  upon  the  dynamic  behavior  of  the  system  such  as  the 
geometry,  link  dimensions  and  inatial  properties.  This  understanding  of  the  dynamic 
behavior  is  difficult  to  obtain  by  just  using  numerical  solutions.  The  explicit  equations  of 
motion  also  are  required  for  designing  control  systems  that  will  improve  the  dynamic 
performance  of  the  parallel  manipulator. 

The  idea  of  using  the  equations  of  motion  of  the  manipulator  for  improving  the  design 
and  developing  high  performance  control  systems  has  been  done  successfully  in  the  area  of 
serial  manipulators  by  H.  Asada  et  al.[13].  The  result  of  this  research  has  been  the 
development  of  the  high  performance  direct  -drive  serial  manipulators  [14]. 
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1.2  Objectives 


The  designer  interested  in  developing  a  platform  based  manipulator  can  usefully  employ 
the  research  performed  to  analyze  a  given  device.  A  set  of  manipulator  parameters  can  be 
determined  by  a  trial  and  error  process  using  the  actual  level  of  knowledge.  However,  this 
process  can  be  very  time  consuming  and  may  produce  a  manipulator  that  is  not  optimal  for 
the  given  application.  The  ultimate  objective  of  this  research  is  to  develop  an  efficient 
computer-based  design  and  analysis  tool  for  parallel  manipulators. 

1.2.1  Dynamic  Modeling 

The  primary  main  objectives  of  this  project  are  to  determine  the  analytical  dynamic 
model  for  parallel  manipulators  and  develop  a  dynamic  simulation  software.  This 
simulation  will  be  the  basis  for  the  computer  base  design  /  analysis  tool  for  parallel 
manipulators.  This  model  can  be  used  for  the  forward  dynamic  analysis  where  the 
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Figure  1.3  -  Forward  Dynamic  Analysis 
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Figure  1.4  -  Inverse  Dynamic  Analysis 
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loads  are  applied  to  the  system  and  the  resultant  motion  is  detamined  as  shown  in  Figure 
1.3.  The  manipulator  specifications  consist  of  the  dimensions,  the  geometry,  the  inertial 
parameters  and  other  parameters  used  for  describing  the  system.  These  will  be  discussed 
in  detail  in  Chapter  2. 

Most  important  is  the  use  of  the  model  for  the  inverse  dynamic  analysis  of  the  parallel 
manipulator.  In  this  case  the  desired  motion  is  specified  and  the  forces  required  to  generate 
this  motion  are  determined  as  shown  in  Figure  1 .4.  The  inverse  dynamic  analysis  is  the 
tool  that  a  designer  would  use  to  determine  if  a  given  manipulator  or  a  proposed  design  is 
capable  of  generating  a  desired  motion.  This  analysis  can  also  be  used  to  determine  the 
effects  of  changing  platform  specifications  on  the  required  forces  which  is  also  usefiil  for 
the  design  process. 

1.2.2  Testing 

The  second  objective  of  this  work  is  to  use  the  dynamic  simulation  for  testing  some 
manipulator  designs.  This  will  enable  the  designer  to  gain  some  basic  insight  of  the 
dynamic  behavior  of  the  system  and  its  relation  to  different  system  parameters  such  as 
.  geometry  and  inertia.  ■ 

1 .3  CAE  Tool  for  Parallel  Manipulators 
Parallel  manipulators  have  in  the  main  been  used  as  flight  simulators  for  training  pilots 
and  for  rides  in  theme  parks  such  as  Disney  World.  They  have  many  other  potential  uses 
in  different  areas  which  have  not  been  explored  yet.  The  development  a  Computer  Aided 
Engineering  tool  for  parallel  manipulators,  such  as  that  shown  in  Figure  1 .5,  will  allow 
designers  to  determine  the  appropriate  design  of  a  platform  based  manipulator  according  to 
the  desired  application.  The  dynamic  simulation,  which  is  the  immediate  objective  of  this 
research,  is  one  of  the  major  building  blocks  for  such  a  tool.  The  designo-  or  user  of  this 
CAE  tool  provides  the  input  through  the  description  of  the  desired  motion  and  task,  and  the 
workspace  requirements.  This  information  is  used  by  the  Manipulator  Design  Module, 
shown  in  Figure  1 .6,  to  determine  some  possible  geometries  and  manipulator  parameters 
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Figure  1.5  -  CAE  tool  for  Parallel  Manipulators 

by  the  Geometry  Selection  and  Connector  Design  submodules.  The  implied  loads  are 
detamined  by  the  Load  Analysis  submodule  using  the  motion  planning  information  and  the 
proposed  geometry.  Finally  the  Inverse  Kinematic  and  Inverse  Dynamic  submodules  are 
used  to  determine  the  actuator  requirements. 
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Figure  1.6  -  Manipulator  Design  Module 

If  the  actuator  requirements  meet  the  design  specifications,  the  software  invokes  the 
Control  System  Design  Module  shown  in  Figure  1.7.  This  module  uses  the  manipulator 
design  generated  in  the  Manipulator  Design  Module  to  determine  the  controller  parametral 
using  the  Manipulator  Control  System  submodule.  Then  the  Forward  Dynamics  and 
Forward  Kinematics  submodules  use  the  controller  design  and  the  actuator  requirements  to 
determine  the  resultant  motion.  This  motion  is  then  compared  with  the  desired  motion  to 
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Figure  1.7  -  Control  System  Design  Module 

determine  whether  the  manipulator  design  is  satisfactory  or  in  the  best  case  the  optimum 
design.  ^ 

1 .4  Research  Outline 

As  mentioned  earlier,  the  development  of  the  CAE  tool  for  parallel  manipulators  is  the 
ultimate  objective  of  a  research  effort  and  this  project  is  one  of  the  initial  phases.  The 
objective  of  this  research  is  to  develop  the  equations  to  be  used  in  the  inverse  and  forward 
kinematics,  and  the  equations  of  motion  for  the  inverse  and  forward  dynamic  analysis. 


The  first  step  required  for  deriving  the  equations  of  motion  is  to  develop  a 
comprehensive  lumped  parameter  model  of  the  manipulator.  In  all  the  previous  research 
into  modeling  [8, 9, 10, 11]  simple  connector  models  have  been  employed.  Although 
adequate  for  a  basic  dynamic  analysis,  these  models  are  not  good  enough  for  complex 
systems  such  as  those  required  for  implicit  force  control  and  for  high  frequency  / 
disturbance  rejection  ^plications.  The  objective  here  is  to  develop  a  complete  lumped 
parameter  model  which  includes  the  effects  of  friction  and  compliance  which  can  become 
significant  factors  in  advanced  applications.  The  lumped  parameter  model  should  be  as 
comprehensive  as  possible  in  order  to  anticipate  the  needs  of  the  designer  and  at  the  same 
time  not  overly  complicated  such  that  it  would  add  unnecessary  computational  overhead. 

The  second  step  is  to  perform  a  complete  inverse  kinematic  analysis.  This  analysis  must 
generate  analytical  expressions  that  relate  the  motion  of  the  platform  to  the  motion  of  the 
connectors  (position,  velocity  and  acceleration).  This  analysis  must  also  generate  the 
equations  for  describing  the  motion  of  the  platform. 

The  third  step  is  to  perform  a  complete  force/torque  analysis  of  the  manipulator.  This 
analysis  determines  the  relationships  between  the  externally  applied  loads,  gravity,  the 
actuator  forces,  the  connector  elements  and  the  inertial  motion  of  the  platform. 

At  the  outset  the  most  important  step  is  to  determine  the  equations  of  motion  for  the 
system  using  the  lumped  parameter  model,  the  kinematic  analysis,  and  the  force/torque 
analysis.  One  important  issue  is  the  selection  of  the  formulation  method  [15]  (Newton- 
Euler,  Lagrange, ...).  The  formulation  method  will  determine  the  difficulty  of  the  deriving 
the  equations  of  motion  and  the  possibility  of  making  mistakes  in  the  derivation. 

Once  the  equations  of  motion  are  derived,  the  dynamic  simulation  software  can  be 
developed  and  tested  using  different  manipulator  designs  and  desired  motions.  This  will 
provide  some  useful  insight  of  the  dynamic  behavior  of  the  system  and  demonstrate  that  it 
is  an  important  component  of  a  future  CAE  tool  for  parallel  manipulators. 


CHAPTER  2 
SYSTEM  LUMPED  PARAMETER  MODEL 

In  most  of  the  dynamic  models  for  parallel  spatial  manipulators,  the  platform  is 
assumed  to  be  a  rigid  body  and  the  legs  are  considered  to  be  rigid  massless  bodies  that 
apply  forces  to  the  platform  as  shown  in  Figure  2. 1  [7,  8, 9, 10].  Although  this  approach 
can  be  considered  a  good  first  approximation,  it  does  not  provide  a  complete  picture.  Most 
of  these  models  do  not  specify  what  is  the  minimum  connector  to  platform  inertia  ratio  at 
which  the  mass  of  the  connector  be  considered  neglible;  nor  the  minimum  connector 
stiffness  values  required  to  consider  the  connector  to  be  infinitely  rigid.  To  be  able  to 
obtain  proper  results  with  such  a  simplistic  model,  the  connectOTS  would  have  to  be 
carefully  designed  so  that  they  are  lightweight  and  extremely  rigid.  This  causes  the  system 
to  be  complex  and  costly.  Therefore  the  advantage  of  using  a  simplistic  model  is  lost  when 
the  design  effort  and  cost  is  factored  in.  It  is  more  practical  to  assume  that  the  connectors 
do  have  some  inertia  and  compliance  that  can  affect  the  system's  dynamic  performance.  In 
this  chapter  more  realistic  connector  models  will  be  presented  and  explained. 

2.1  Energy  Coupling 
One  of  the  most  significant  effects  of  the  connectors  is  the  additional  mass  and  moment 
of  inertia  that  they  contribute  to  the  system.  The  total  mass  of  the  connector,  M  e,  is  the 
sum  of  the  mass  of  the  connector  itself  and  the  mass  of  the  actuator.  A  simple  model  which 
includes  the  effects  of  the  mass,  M  e,  is  shown  in  Figure  2.2.  In  this  model  the  mass 
moves  in  the  direction  s ,  a  unit  vector  parallel  to  the  connector,  when  the  actuator  moves. 
The  connector  is  assumed  to  be  frictionless  and  rigid  (this  is  why  no  elastic  or  frictional 
elements  are  used  in  the  model).  The  actuator  now  has  more  inertia  to  move  than  when  the 
ideal  connector  model  is  used  (when  the  connector  is  rigid  and  massless).  The  change  of 
the  actuator's  force  is  given  by: 
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Figure  2.1  -  Spatial  Parallel  Manipulator  with  rigid  and  massless  connectors 

AFa=Mefi 

where  Fa  is  the  actuator's  force,  and  E  is  the  displacement  of  the  mass  of  the  connector  as 
shown  in  Figure  2.2.  The  inertial  effect  is  caused  by  this  mass  is  compounded  by  the  fact 
that  it  is  also  rotating.  In  this  case  the  actuators  will  also  have  to  generate  the  additional 
forces  to  cause  the  rotation  of  these  connector  masses.  The  rotation  of  this  mass  will 
require  a  normal  acceleration  term  since  the  body  is  rotating;  and  a  CorioUs  acceleration 


Figure  2.2  -  Connector  model  with  the  actuator  mass 
term  since  the  body  is  translating  and  rotating  at  the  same  time 

Anormal  =  E(iO)^;        A  coriolis  =  2  E  x  (0 

where  to  is  angular  velocity  vector  of  the  connector.  The  manipulator  will  also  store  more 

kinetic  energy  when  the  connector  masses  are  included.  The  actuators  will  have  to  exert 
more  force  to  speed  up/slow  down  the  system  since  more  energy  must  be  added/removed 
from  the  system. 

In  the  parallel  manipulator  system,  the  actuators  will  increase  (speed  up)  or  decrease 
(slow  down)  the  energy  content  of  the  platform.  The  speed  of  response  is  a  function  of 
how  fast  the  actuators  can  transfer  energy,  stored  in  the  form  of  kinetic  energy,  to  or  from 
the  moving  platform  as  shown  ui  Figure  2.3.  The  block  diagram  on  the  left  illustrates  the 
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Figure  2.3  -  Energy  How  in  Parallel  Manipulators 

energy  flow  when  the  manipulator  is  sped  up;  the  right  block  diagram  illustrates  the  energy 
flow  wheal  the  energy  level  of  the  manipulator  is  decreased  (slowed  down). 

When  the  connectors  are  assumed  to  be  rigid  and  massless,  the  actuators  only  have  to 
transfer  energy  to  or  finom  the  platform.  When  a  more  realistic  connector  model  is  used,  the 
actuators  have  to  transfer  energy  to  or  from  the  platform  and  the  connector  masses.  For  the 
same  desired  platform  velocity,  the  energy  level  required  is  higher  when  the  realistic 
connector  model  is  used  and  the  system's  speed  of  response  or  reaction  time  is  slower.  In 
order  to  increase  the  velocity,  the  actuators  have  to  add  enra-gy  to  the  platform  and  the 
connectors .  When  the  system  has  to  be  slowed  down,  the  actuators  have  to  remove 
energy  from  the  platform  and  the  connectors.  The  decrease  of  the  speed  of  response  can  be 
detrimental  to  the  performance  of  the  platform  if  the  connector  masses  was  not  taken  into 
account  when  designing  the  system.  The  actuators  have  to  mare  powerful  if  the  original 
speed  of  response  is  desired.  The  use  of  more  realistic  connector  models  will  help  to 
quantify  the  decrease  of  the  speed  of  response  which  will  provide  the  designer  with  more 
accurate  information  when  selecting  the  actuators. 


2.2  Basic  Connector  Model  < 

The  simplest  model  for  the  connector  of  a  spatial  parallel  manipulator  is  a  rigid  massless 
body.  A  more  realistic  but  simple  model  for  the  connector  is  shown  in  Figure  2.4.  The 


14  , 

mass  M  e  is  the  lumped  mass  of  the  connector  and  the  moving  part  of  the  actuator;  this 

includes  the  inertia  of  the  actuator  and  the  transmission  used  to  convert  rotational  motion  to 
linear  motion  when  a  rotational  actuator  is  used.  A  transmission  is  not  required  if  a  linear 
actuator  such  as  a  hydraulic  piston  is  used.  The  base  mass  of  the  actuator,  M  b ,  is  the  fixed 

part  of  the  actuator  (this  is  in  the  direction  of  translational  motion,  the  complete  connector 
will  rotate  when  the  system  is  moving).  In  this  model,  the  deformation  of  the  connector 
and  the  friction  of  the  actuator  are  also  considered  and  are  described  by  the  lumped 
parameter  elements  K  l  and  C  t,  respectively.  The  parameters  and  variables  used  in  this 

basic  connector  model  are  (  see  Figure  2.4 ) 
E ,  the  displacement  of  the  connector  along  the  s  direction; 
K  L ,  the  equivalent  stiffness  of  the  connector; 

C  t ,  the  actuator  and  transmission  friction,  modeled  as  a  viscous  damper,  and 

F  a ,  the  force  produced  by  the  actuator. 
The  equivalent  force  of  the  actuator  is  determined  by  using  the  torque  and  the  transmission 
ratio  of  the  actuator.  This  force  (or  torque)  can  be  further  related  to  the  commands  that  the 
confroller  sends  to  the  actuators.  The  force  that  the  connector  applies  to  the  platform  is  a 

function  of  its  displacement  e ,  and  the  connector  stiffness  K  l 

F  =  KLe  (1) 

If  the  connector  is  very  stiff  (Ki  =»  °°),  the  actuator  becomes  rigidly  coupled  to  the 
platform. 

When  the  actuator  is  rigidly  coupled  to  the  platform,  any  damping  or  compliance 
required  by  the  platform  for  vibration  or  force  control  must  be  provided  by  the  active 
control  of  the  actuator.  In  this  case  the  dynamic  behavior  is  mostly  determined  by  the 
dynamic  response  of  actuator  and  controller.  The  dynamic  response  can  be  tJiilored 
according  to  the  desired  performance  criteria  (within  the  dynamic  response  capabilities  of 
the  actuator ).  The  main  disadvantage  is  that  the  power  efficiency  of  the  system  is  reduced 
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Figure  2.4  -  Basic  Connector  Model 

when  the  actuators  (active  devices)  are  used  to  simulate  springs  and  dampers  (passive 
devices).  An  actuator  can  be  made  to  behave  as  a  damper  and  all  the  energy  will  be 
dissipated  by  the  actuator.  This  can  overheat  the  actuator,  causing  a  degradation  in 
poformance  and  in  the  worse  case  lead  to  an  actuator  bumouL  Furthermore,  employing 
actuators  as  energy  dissipators  is  costly.  Better  energy  disspation  can  be  achieved  by 
incorporating  a  passive  fnctional  element  such  as  a  viscous  damper.  Similar  disadvantages 
will  be  encountered  when  the  actuator  is  used  as  a  spring.  Another  main  disadvantage  is 
that  the  dynamic  response  of  the  controller  /  actuator  combination  might  not  satisfy  the 
desired  system  dynamic  performance. 
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2.3   Implicit  Force  Control 

One  way  to  reduce  or  eliminate  the  complications  associated  with  employing  the 
actuator  as  a  passive  device  is  to  include  an  actual  spring/damper  pair  between  the 
connector  and  the  platform  as  shown  in  Figure  2.5.  This  is  a  model  suitable  for  describe 
the  behavior  of  the  system  when  the  implicit  force  control  scheme  is  employed  [16].  The 
additional  components  are  as  follows 

K  c ,  is  the  stiffness  element  between  the  connector  and  the  platform. 

C  c ,  is  the  viscous  damping  element  between  the  connector  and  the  platform. 
The  Implicit  Force  Control  scheme  generates  a  force  by  controlling  the  displacement  of  an 
stiffness  element  [16].  The  spring  in  the  coupling  stage  between  the  connector  and  the 
platform  can  be  used  for  such  a  control  scheme,  the  damper  can  be  used  to  limit  the 
system's  vibrations  in  the  connector.  The  force  F  that  the  connector  applies  to  the  platform 

is  a  function  of  the  displacement  of  the  coupling  stage  A ,  and  its  first  time  derivative,  the 

stiffness  K  c  and  the  damping  coefficient  C  c.  It  can  be  determined  by  using  the  following 
equation 

F=(KcA  +  Cc^)s  (2) 

whCTe  s  is  a  unit  vector  parallel  to  the  connector.  It  can  now  control  a  force  by  simply 
controlling  a  displacement  variable  A  and  its  first  time  derivative  and  this  process  is  called 

Implicit  Force  Control.  The  actuator  of  the  connector  still  has  to  generate  a  force  in  order  to 
balance  the  force  developed  in  the  coupling  spring  and  damper.  The  coupling  spring  is 
selected  to  be  much  more  compliant  than  the  connector,  hence  most  of  the  deflection  occurs 
in  the  coupling  spring.  This  type  of  connector  is  well-suited  for  controlling  the  contact 
force  between  the  platform  and  a  rigid  surface.  Upon  contact,  the  platform  will  yield  to  the 
shape  of  the  rigid  surface.  An  example  would  be  the  polishing  of  a  mirror  or  glass  with  the 
platform.  The  contact  force  must  be  kept  below  some  value  to  avoid  damaging  the  surface. 
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Figure  2.5  -  Connector  Model  for  the  Implicit  Force  Control 

One  of  the  major  disadvantages  of  employing  this  model  is  the  relatively  long  time  delay 
that  the  coupling  stage  introduces.  When  the  actuator  applies  a  force,  the  coupling  stage 
has  to  deform  before  the  force  is  transmitted  to  the  platform.  This  reduces  the  speed  at 
which  the  actuator  force  can  be  applied  to  the  platform,  and  therefore  the  reaction  time  of 
the  complete  system  is  increased.  This  constitutes  a  major  problem  when  high  frequency 
disturbance  forces  are  applied  to  the  platform  such  as  those  generated  when  using  the 
manipulator  to  support  a  workpiece  that  is  being  machined.  The  reaction  time  could  be  too 
slow  in  order  to  apply  the  required  equilibrant  forces  to  counteract  these  disturbances. 


The  damping  element  helps  dissipate  some  of  the  energy  the  high  frequency 
disturbances  apply  to  the  platform.  The  disadvantages  of  using  the  damping  element  in  the 
model  are  that  it  also  increases  the  reaction  time  of  the  system.  Furthermore,  some  of  the 
energy  of  the  actuator  is  dissipated  in  this  element  instead  of  being  transmitted  to  the 
platform. 

2.4  Modified  Implicit  Force  Control  Mode 
The  use  of  a  coupUng  damping  element  is  not  so  effective  in  eliminating  high  frequCTcy 
disturbances,  since  the  vibrations  will  be  transmitted  to  the  actuator  through  the  connector 
stiffness  element  A  possible  solution  to  this  problem  is  the  use  of  a  decoupling  stage  in 
parallel  with  the  connector  [17].  The  model  used  for  the  implicit  force  control  scheme  can 
be  modified  as  shown  in  Figure  2.6,  the  additional  components  are 
.  is  the  decoupling  stiffness  element. 

Cd ,  is  the  decoupling  viscous  damping  element 
Md ,  is  the  decoupling  stage  mass. 

The  decoupling  stage  damper  Cd  is  used  to  reduce  or  eliminate  the  high  frequency 
disturbances.  This  damper,  unlike  the  coupling  damping  element  Cc,  will  not  transmit  the 
vibrations  to  the  actuator.  Further  more,  it  reduces  the  need  to  use  the  actuator  as  a  passive 
energy  dissipating  element  when  high  frequency  disturbances  are  applied  to  the  platform. 
The  decoupling  stage  spring  must  be  a  very  stiff  component,  as  it  models  the  support  of  the 
decoupling  damper.  If  this  spring  is  too  compliant,  the  energy  applied  to  the  decoupling 
stage  will  deform  the  ^ring  instead  of  being  dissipated  in  the  decoupling  damping  element 
This  energy  will  be  returned  to  the  platform  increasing  the  vibrations  instead  of  reducing 
them.  At  high  frequencies,  the  decoupling  damper  generates  a  high  reactive  force  that  can 
be  used  to  counteract  the  high  frequency  disturbances.  The  force  F  applied  by  the 
connector  to  the  platform  is  a  combination  of  the  forces  generated  in  the  coupling  and 
decoupling  stages.  The  force  generated  in  the  coupling  stage  can  be  calculated  by  using 
equation  (2).  The  force  generated  in  the  decouphng  stage  is  a  function  of  the  first  time 
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derivative  of  the  its  displacement  X,  and  the  damping  coefficient  C  a-  The  force  applied  to 
the  platform  can  be  calculated  by  using  the  following  equation 

dt  dt 

The  connector  can  now  partially  contix)l  a  force  by  just  controlling  a  displacement  variable 


Figure  2.6  -  Connector  model  for  the  Modified  Implicit  Force  Control 
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A  i  and  its  first  time  derivative.  This  component  of  the  force  F  is  determined  by  the  first 

two  terms  of  equation  (3).  The  main  drawback  of  using  the  decoupling  stage  is  that  it  will 
always  be  dissipating  energy.  The  decoupling  stage  can  dissipate  energy  from  either  the 
disturbance  force  (which  is  the  intended  purpose)  or  from  the  actuator.  In  this  latter  case, 
part  of  the  energy  input  fi"om  the  connector  actuator  is  being  dissipated  in  the  connector 
instead  of  being  used  to  move  the  platform.  Another  disadvantage  in  using  the  decoupling 
stage  is  the  increase  of  mass  and  moment  of  inertia  caused  by  the  element  M  j.  Some  of  the 
energy  of  the  system  will  be  used  to  move  this  additional  inertia. 

2.5  Combined  High  Frequency  /  Low  Frequency  Connector  Model 
It  would  be  most  desirable  to  have  a  connector  capable  of  implementing  the  implicit 
force  control  scheme  with  minimum  energy  loss  at  low  frequencies  (such  as  the  one  shown 
in  Figure  2.3,  which  has  no  decoupling  stage),  and  a  connector  capable  of  effective 
disturbance  rejection  for  high  frequency  applications.  The  coupling  stage  is  undesirable  for 
high  frequency  applications;  the  decoupling  stage  is  not  very  useful  for  low  frequency 
ai^lications  and  reduces  the  power  efficiency  of  the  actuators. 

A  solution  is  to  have  a  single  connector  with  the  capability  of  optimal  performance  at 
either  low  frequencies  or  high  frequencies.  This  can  be  achieved  provided  that  the 
decoupUng  and  coupling  stages  employ  viscous  dampers  with  proportional  control  valves. 
The  damping  coefficient  of  a  viscous  damper  can  be  regulated  by  opening  or  closing  the 
valve.  When  the  valve  is  fully  closed,  the  viscous  damper  is  locked  (the  viscous  damping 

coefficient  is  extremely  high,  C=*°°)  and  will  behave  as  an  very  rigid  component  with 

no  damping.  When  the  valve  is  completely  open,  the  damper  will  act  as  a  very  low  energy 

dissipating  element  (the  damping  coefficient  C  ==»  0 ).  For  the  low  frequency  mode,  the 

decoupling  stage  must  be  inactive  (no  energy  will  be  dissipated  in  this  stage).  This  can  be 
achieved  by  completely  opening  the  control  valve  of  the  decoupling  damper.  The 
decoupling  stage  would  only  dissipate  a  small  amount  of  energy.  In  this  case,  the  only 
noticeable  effect  of  the  decoupling  stage  would  be  its  mass.  This  mass  can  be  grouped 
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Figure  2.7  -  Connector  model  for  the  High  Frequency  Mode 

with  the  actuator  base  mass.  The  control  valve  of  the  coupling  damper  would  be  set  to  an 
opening  that  would  provide  the  desired  viscous  damping  for  the  coupUng  stage.  The 
connector  model  would  similar  to  the  one  shown  in  Figure  2.5,  the  difference  being  the 
higher  base  inertia  M'b = M  b  +  M  a- 

For  the  high  frequency  mode,  the  coupling  stage  must  be  inactivated.  This  can  be  done 
by  completely  closing  the  control  valve  of  the  coupling  damper.  When  the  valve  of  the 
coupUng  damper  is  completely  closed,  it  acts  as  an  extremely  rigid  element  This  means 
that  there  are  no  deflections  in  the  coupling  stage.  The  control  valve  of  the  decoupling 
damp©-  would  be  set  according  to  the  desired  damping  coefficient  for  the  decoupling  stage. 
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The  connector  model  for  this  case  is  the  one  shown  in  Figure  2.7. 

Another  possible  mode  of  operation  of  this  multi-purpose  connector  would  be  to 
inactivate  the  decoupling  and  coupling  stages  by  completely  opening  the  control  valve  of 
the  decoupling  damper  and  completely  closing  the  control  valve  of  the  coupling  damper. 
The  connector  model  to  be  used  in  this  case  is  the  one  shown  in  Figure  2.4.  This  allows 
the  designer  to  tailor  the  dynamic  response  of  the  system  by  designing  an  appropriate 
controller. 

2.6  Connector  Model  for  Dynamic  Modeling 
The  final  connector  model  that  will  used  for  developing  the  system's  complete  dynamic 
model  is  shown  in  Figure  2.8.  This  has  all  the  components  described  in  the  previous 
sections.  The  objective  is  to  develop  a  model  that  can  exhibit  the  system  behavior  in 
different  operating  modes.  Each  connector  requires  the  following  coordinates  or  variables 
to  describe  its  complete  configuration 

s  ,  is  a  unit  vector  parallel  to  the  connector. 

E  ,  is  the  location  of  M  i  along  the  connector's  direction. 

H  ,  is  the  actual  length  of  the  connector  (the  coupling  stage  is  not  included). 

L  ,  is  the  total  length  of  the  connector 

D  ,  is  the  location  of  the  connection  between  the  decoupling  spring  and  dampo". 

bl  ,  is  the  distance  of  the  base  mass,  M  b,  from  the  connector's  base  joint  ( this  a  fixed 

distance). 

s  and  L  are  dependent  variables  which  can  be  described  in  terms  of  the  platform's  location 
and  orientation.  Each  of  the  connectors  has  3  degrees  of  freedom  since  the  coordinates  E, 

H,  D  are  independent  variables. 
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Figure  2.8  - 


Complete  Connector  Lumped  Parameter  Model 


CHAPTER  3  ' 
PARALLEL  MANIPULATOR  KINEMATICS 


The  dynamic  state  of  a  multi-body  system  is  a  function  of  the  position,  velocity  and 
acceleration  of  the  multi-connected  bodies.  It  is  therefore  neccessary  to  perform  a  complete 
kinematic  analysis  of  the  system. 

The  required  input  forces  and  torques  can  be  determined  for  a  specified  kinematic  state 
of  a  system  (position,  velocity  and  acceleration).  This  is  known  as  the  inverse  dynamic 
formulation.  It  is  also  possible  to  compute  the  kinematic  state  of  the  system  for  a  specified 
set  of  values  of  input  forces  and  torques.  This  is  known  as  the  foward  dynamic 
formulation.  In  the  case  of  a  spatial  parallel  manipulator,  the  kinematic  state  of  the  system 
(position,  velocity  and  acceleration)  will  be  specified  according  to  a  desired  task;  and  thai  , 
the  forces  and  torques  required  to  produce  such  kinematic  state  will  be  calculated. 

3. 1  Forward  and  Inverse  Kinematics 

The  spatial  parallel  manipulator  or  platform  is  a  6-degree-of-ft-eedom  system.  The 
location  (position  and  orientation)  of  the  platform  is  determined  by  the  length  of  each  of  the 
six  connectors.  When  the  six  connector  lengths  are  specified,  the  location  and  orientation 
of  the  platform  can  be  determined.  This  is  known  as  the  forward  displacement  analysis  and 
it  is  extremely  difficult  because  there  are  multiple  solutions  [2].  Fortunately,  the  foward 
displacement  analysis  of  parallel  manipulators  is  not  required  for  the  dynamic  analysis  of 
the  system. 

On  the  other  hand,  it  is  relatively  simple  to  compute  a  unique  set  of  connector  lengths 
when  the  location  of  the  platform  is  specified.  This  is  known  as  the  inverse  displacement 
analysis  and  is  useful  in  developing  the  dynamic  model  of  the  system.  The  location  of  the 
platform  must  be  specified  when  it  is  used  for  example  to  present  a  workpiece  to  a  machine 
tool  or  it  is  used  as  a  flight  simulator.  The  displacement  and  orientation  of  each  of  the 
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connectors  that  actuate  the  platform  can  be  determined,  once  its  motion  time  history  has 
been  specified.  The  inverse  kinematics  formulation  will  be  used  in  describing  the  motion 
of  the  system  because  it  is  more  application-oriented. 

3.2  Kinematic  Relationships 
Prior  to  the  kinematic  analysis  of  the  platform,  some  basic  kinematic  relationships 
required  for  such  analysis  will  be  derived. 

3.2. 1  Location  Analysis  of  the  Platform 

The  location  of  the  platform  will  be  specified  firstly  by  defining  a  position  vector  C  that 
locates  the  center  point  c  of  the  platform  (which  is  also  its  center  of  mass)  together  with  its 
orientation  as  shown  in  Figure  3. 1.  This  location  is  used  to  determine  the  length  and 


Figure  3.1  -  Base,  Platform  and  position  vectors 
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orientation  of  each  of  the  connectors.  In  Figure  3.1  a  point  O  is  chosen  which  is  the  origin 
of  a  set  of  fixed  axes  which  is  called  the  base  frame.  The  ends  of  any  connector  are  labeled 
p  and  b  (see  Figure  3. 1)  and  the  corresponding  position  vectors  drawn  from  O  are  P  and  B 
respectively. 

3.2.2  Description  of  the  Orientation  of  the  Platform 

The  orientation  of  the  platform  can  be  described  by  a  set  of  three  mutually 
perpendicular  unit  vectors  attached  to  the  platform  :  X  m,  Y  m  &  Z  m-  These  vectors  form  a 

right  handed  set  with  an  origin  at  point  c  and  define  the  moving  frame  of  the  platform. 
Each  of  these  vectors  is  described  by  three  parameters  (the  directional  cosines  for  each 
vector).  Although  nine  parameters  are  required  to  define  these  three  vectors,  there  really 
are  only  three  independent  parameters  since  the  following  six  constraints  that  have  to  be 
satisfied 

-  For  example,  choosing  unit  vectors  yields  three  constraints 

|Xm|=l  ;  |Yml=l  &  |Zml=l 

-  For  mutually  perpendicular  vectors,  their  scalar  products  must  be  zero,  which  yields  a 
further  three  constraints 

Xm-Ym  =  0;      Xni-Zn,  =  0    &    Zni-Ym  =  0 

Therefore  only  three  parameters  have  to  be  specified  to  completely  describe  the  orientation 
of  the  platform  with  respect  to  the  base  (three  degrees  of  freedom). 

The  specification  of  the  frame  of  reference  for  the  platform  depends  upon  the  desired 
system  motion  which  is  based  on  the  motion  and  task  planning.  This  will  be  discussed 
later  in  the  Section  3.6. 
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3.3  Position  Analysis 
The  location  of  the  platform  can  be  specified  by  the  position  of  the  center  point  c  and 
tiie  orientation  of  the  platform  itself.  The  position  of  any  point  on  the  platform  can  be 
determined  by  using  the  following  equation 


where  P  is  Uie  position  of  point  p  on  the  platform,  defined  in  the  base  frame  coordinate 
system;  C  is  the  position  of  the  center  point  c  ;  R  pc  is  the  relative  position  vector  of  point 
p  with  respect  to  the  center  point  c  as  shown  in  Figure  3.2.  These  position  vectors  are 
defined  with  respect  to  the  fixed  or  the  base  coordinate  system. 

The  relative  position  vector  R  pc  is  defined  with  respect  to  a  coodinate  system  that  is 
parallel  to  the  base  coordinate  system,  has  its  origin  at  c  and  is  defined  by  the  unit  vectors 


P  =  £  R 


pc 


(1) 


Zf  Z 


m 


platform 
coordinate 
system 


base 

coordinate 
system  "~ 


X 


Figure  3.2  -  Location  Analysis 
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X  f,  Y  f ,  and  Z  f  as  shown  in  Figure  3.2.  The  vector  R  pc  can  also  be  defined  with  respect 
to  the  moving  coordinate  system  or  the  platform's  coordinate  system  as 

S  pc/m  =  [  X  pc/mi  y  pc/nn  ^  pc/m  ]  ^• 

This  vector  is  a  constant  when  defined  in  the  moving  coordinate  frame  regardless  of  the 
orientation  of  the  platform. 

The  unit  vector  Xm  can  be  described  in  the  fixed  coordinate  frame  as  (  see  Figure  3.3 ) 

Xm  =  a,iXf +ai2Yf +ai3Zf  (2.a) 

where  an,  a  12  &  a  13  are  the  direction  cosines  of  the  unit  vector  X  m  with  respect  to  the 
fixed  coordinate  frame.  In  a  similar  fashion,  the  unit  vectors  Y  m  and  Z  ^  can  also  be 
defined  in  the  fixed  coordinate  frame  using  their  respective  directional  cosines 

Ym  =  a2iXf +a22Yf +a23Zf  (2.b) 
Zm  =  a3iXf +a32Yf +a33Zf  (2.c) 


Figure  3.3  -  Vector  X  m  described  in  the  fixed  coordinate  frame 


The  relative  position  vector  can  be  written  as 
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S  pc/m  -  X  pc/m  X  m  +  y  pc/m  X  m    z  p^^nj  Z  m 

The  relative  position  vector  can  be  written  with  respect  to  the  fixed  coordinate  frame  by 
combing  the  above  equation  and  equations  (2.a),  (2.b)  and  (2,c) 


aiiXf 

a2lX  f  ^ 

a3iXf 

ai2Yf 

ypc/m 

a22Yf 

^pc/m 

aszXf 

. a^Zf _ 

.  a23Zf  _ 

_  a33Zf 

The  vector  R  pc  can  be  also  be  written  as 

Kpc/f  =  Xpc/f  X  f  +  ypc/f  Y f  +  Zpc/m  Zf 

where  the  components  are  given  by 

Xpc/f  =  Xpc/mau  +  ypc/mai2  ■*"  Zpc/man  O-a) 

ypc/f  =  Xpc/ma21  +  ypc/m  a22  +  Zpc/ma23 

Zpc/f  =  Xpc/masi  ■*"ypc/ma32'^2:pc/ina33  (3.c) 


By  using  equations  (3.a),  (3.b)  and  (3.c)  the  relative  position  vector  is  transformed  from 
the  moving  coordinate  frame  to  the  fixed  coordinate  frame.  This  relationship  can  be  written 
in  matrix  form  as 


Spc  - 


ail  ai2  ai3 
a2i  a22  a23 
aai   a32  a33 


Spc/m 


(4) 


The  3x3  matrix  is  generally  known  as  the  rotation  matrix  or  the  transformation  matrix 
since  it  transforms  a  vector  from  one  coordinate  system  to  a  second  coordinate  system  [18]. 
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The  matrix  elements  are  the  directional  cosines  of  the  unit  vectors  of  the  first  coordinate 
system  with  respect  to  the  second  coordinate  system  and  are  a  function  of  the  orientation  of 
the  platform  with  respect  to  the  fixed  coordinate  frame.  The  specification  of  these 
directional  cosines  as  a  function  of  the  desired  motion  of  the  platform  will  be  discussed  in 

detail  in  Section  3.6. 

The  center  point  position,  given  by  the  vector  C  ,  is  a  user  defined  vector  characterized 

by  three  variables:  C  =  [  Xc ,  Yc ,  Zc  ]  ^.  Each  of  these  variables  is  a  function  of  time. 

The  position  of  the  platform  can  be  varied  by  changing  the  location  of  the  center  point 
and/or  the  orientation  matrix  of  the  platform.  In  order  to  completely  locate  the  platform, 
three  variables  must  be  specified  for  the  centerpoint's  location  and  three  variables  for  the 
platform's  orientation.  Therefore  the  platform  has  6  degrees-of-freedom. 

3.3.1  Connector  Length  and  Orientation 

The  length  and  the  orientation  of  each  connector  can  be  calculated  once  the  position  of 
the  points  b  and  p  on  each  connector  is  known  (  see  Figure  3.4 ).  The  position  of  point  p 
can  be  calculated  using  equation  (1).  The  location  of  point  b  is  specified  when  defining  the 

geometry  of  the  manipulator.  The  Pliicker  line  coordinates  for  each  connector,  [  s,  s  o  ]  ^, 
are  calculated  using 

S  =  [s  ;  s  ol  ;  s  =  Direction  of  the  line ;  s  o  =  Moment  of  the  Line 

_  [P-B]  _ Bx[P-B] 

|P-B|   '  |P-B| 

The  direction  and  the  moment  of  the  line  are  defined  with  respect  to  the  base  fiame 
coordinate  system  as  shown  in  Figure  3.4.  A  vector  L  along  the  connector  can  be  defined 
as 

L  =  P-B=[L]s    =>    vector  along  the  connector 
L  =  1 P  -  B I  =>  length  of  the  connector  ;  s  =     "  ^   =»  unit  vector  along  tiie  connector 
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Figure  3.4  -  Connector  Location  Analysis 


3.4  Velocity  Analysis 
The  velocity  and  angular  velocity  (also  known  as  the  velocity  state)  of  a  point  on  a  rigid 

body  such  as  the  platform  can  be  described  by  a  twist,  T 


T  = 


Yo 

CO 


where  w  is  the  angular  velocity  vector  and  V  o  is  the  velocity  of  the  point  O  on  the  rigid 

body  coincident  with  the  point  of  reference  [19,  20, 21,  22].  This  twist  or  rotor  can  be 
modeled  as  the  resultant  instantaneous  motion  generated  by  the  rotation  about  a  screw  with 
axis  s  and  a  pitch  h 


T  =  io 


[EoXs]  +  hs 


(6) 


where  r  o  is  vector  fipom  the  point  O  to  the  axis  of  the  screw  as  shown  in  Figure  3.5.  The 
velocity  of  point  O  is  given  by 

Yo  =  w[(roXs)  +  hs]  (7) 

The  instantaneous  motion  or  velocity  of  the  centerpoint  c  can  be  described  using  the  same 
notation  by  relocating  the  origin  at  point  c.  This  can  be  done  by  substituting  r  o  for 

rc=ro-C 

Yc  =  w[(rcxs  )  +  hs]  (8) 

Using  equation  (7),  the  velocity  of  point  c  can  also  be  written  as 

Yc  =  Yo-co(Cxs)  (9) 


Figure  3.5  -  Instantaneous  Motion  Analysis 
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The  instantaneous  motion  or  velocity  of  any  point  p  on  the  platform  can  be  described  using 
the  same  notation  by  relocating  the  origin  to  that  given  point.  The  velocity  of  point  p  can 
be  determined  by  relocating  the  origin  at  point  p.  This  can  be  done  by  substituting  r  „  for 

Ep~Eo"£  ~  K  pc 

Yp  =  to[((ro-C  -Rpc)xs  )  +  hs]  (10) 

By  combining  equations  (8)  and  (10),  the  velocity  V  p  can  be  also  be  written  as  a  function 
of  the  angular  velocity  vector  to  and  the  velocity  of  the  centerpoint  of  the  platform 

Yp  =  Vc  +  (wxRpc)  (11) 

where  V  p  is  the  velocity  of  point  p,  Y  c  is  the  velocity  of  the  centerpoint,  to  is  the  angular 

velocity  vector  of  the  platform  ( to  =  cOxi     Wyj  +  tOzk  )  and  Rpc  is  the  relative 

position  vector  of  point  p  with  respect  to  the  centerpoint.  The  velocity  vector  V  p  can  then 
be  written  as  in  its  expanded  form  as 


cx 

to 

X 

pcx 

/v 

cx 

+  00  • 

y 

R 

pcz 

-  CO  • 

z 

Vy^ 

V 

cy 

+ 

to 

y 

X 

^pcy 

V 

cy 

+  CO  • 

z 

R 

pcx 

-  to 

X 

R 

pcz 

\  cz/ 

CO 

\  z/ 

\  pcz/ 

+  CO  • 

X 

R 

icy 

-  CO  • 

y 

D 

pcx/ 

3.4. 1  Connector  Velocity  Analysis 

The  parallel  manipulator  is  made  up  of  a  platform  joined  to  a  fixed  body  or  base 
through  six  connectors  acting  in  parallel.  Each  cormector  consists  of  a  serial  HPS 
kinematic  chain.  The  letters  H,  P  and  S  denote  respectively  the  Hcx)ke  joint  and  prismatic 
and  spherical  pairs  and  the  order  in  which  these  pairs  are  connected.  The  Hooke  joint  is 
connected  to  ground,  the  prismatic  joint  which  is  the  only  actuated  joint  is  the  intermediate 
pair  and  the  spherical  joint  connects  to  the  platform  as  shown  in  Figure  3.6. 


The  coordinates  for  the  twist  or  velocity  state  of  the  end  effector  or  platform  can  be 
written  as  (see  Figure  3.7) 


i=toiS  1  +  W2S2  + V3S3  +  W4S4  + W5S5  +  W6S6  (12) 

where  S  1  and  S  2  are  the  line  coordinates  of  the  pair  of  intersecting  rotors  modelling  the 
Hooke  joint  of  the  HPS  manipulator;  S  4,  S  5  and  S  6  are  the  line  coordinates  of  the  three 

rotors  modeUing  the  spherical  pair;  and  S  3  are  the  Une  coordinates  of  the  prismatic  pair 


S3  = 


§3 
0 


(13) 


Figure  3.6  -  The  HPS  serial  manipulator 


where  s  3  is  a  unit  vector  parallel  to  the  connector.  By  selecting  point  p,  the  cento-  of  the 
spherical  pair,  as  the  origin  of  the  coordinate  system  equation  (12)  can  be  written  in  the 
form 


(0 


=  (0i 


2ol 
Si 


+  W2 


So2 
§2 


+  V3 


§3 

0 


+  C04 


0 

S  4 


+  C05 


0 

§5 


+  W6 


0 

§6 


(14) 


It  can  be  seen  that  the  velocity  vector  Vp  is  only  a  function  of  the  first  three  rotors  of  the 
HPS  chain 


Vp  =  coiSoi  +W2S02  +  V3S3 


(15)  ^ 


The  direction  vector  of  the  angular  velocity  w  1,  s  1,  is  a  stationary  or  fixed  vector  that  will 
be  selected  to  be  parallel  to  the  fixed  X  f  axis.  The  direction  vector  of  the  angular  velocity 
1^2,  §2,  is  perpendicular  to  the  direction  vectors  s  1  and  s  3  ,  as  shown  in  Figure  3.8  , 


spherical 
^  joint 


Xb  ^\ 


Figure  3.7  -  Rotors  of  the  HPS  Manipulator 


Figure  3.  8  -  Hooke  Joint  at  the  connector's  base 


and  can  be  determined  by 


S2=S 1 ^§3 


Since  the  vector  s  i  is  parallel  to  the  fixed  X  f  axis,  vector  s  2  is  confined  to  the  YZ  plane. 
The  required  line  coordinates  for  evaluating  equation  (15)  are  given  by 


where  P  is  the  position  vector  of  point  p,  B  is  the  position  vector  of  point  b  and  L  is  the 
vector  along  the  connector  from  point  b  to  point  p.  The  line  coordinates  for  rotors  1  and  2 
can  also  be  written  as 

s  oi  =  Ls  1  X  s  3  =  Ls  2  ;     s  o2  =  Ls  2   s  3  =  Ls  23 

where  the  vector  s  23  =  s  2  x  s  3.  Using  the  line  coordinates  for  the  three  rotors  and 
equation  (15),  the  velocity  vector  Vp  can  be  written  as 


Sol=-LS3XSi;      So2  =  -LS3XS2;     83  = 


[P  B] 
|P-B| 


(16) 


Vp  =  L(0iS2  +  L102S  23  +  V3S  3 


(17) 
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3.4.2  Inverse  Velocity  Analysis 

For  the  dynamic  analysis  it  is  most  important  to  determine  the  velocity  of  the  prismatic 
pair  and  the  angular  velocity  of  the  Hooke  joint  of  the  HPS  manipulator.  A  unit  force 
vector  acting  along  the  connector  itself  has  the  following  ray  coordinates 


§3  = 


§3 

0 


This  force  is  clearly  reciprocal  to  the  rotors  1, 2, 4, 5  and  6.  Forming  the  reciprocal 
product  of  this  unit  force  with  equation  (11)  yields  the  following  expression  for  the 
prismatic  pair  velocity  V  3 

V3=Yp-S3  (18) 

A  unit  force  vector  acting  along  unit  vector  s  2  and  going  through  point  p  has  the  following 
ray  coordinates 


^  * 
S2  = 


§2 

0 


This  force  is  clearly  reciprocal  to  the  rotors  2, 3, 4, 5  and  6.  Forming  the  reciprocal 
product  of  this  unit  force  with  equation  (11)  and  using  the  line  coordinates  derived 

previously  yields  the  following  expression  for  the  angular  velocity  co  1 


Yp-S2 


(19) 


A  unit  force  vector  acting  along  unit  vector  §23  ^nd  going  through  point  p  has  the 
following  ray  coordinates 


§23  = 


§23 
0 
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This  force  is  clearly  reciprocal  to  the  rotors  1, 3, 4, 5  and  6.  Forming  the  reciprocal 
product  of  this  unit  force  with  equation  (11)  and  using  the  line  coordinates  derived 

previously  yields  the  following  expression  for  the  angular  velocity  w  2 


The  connector  angular  velocity  vector  w  12  is  defined  as  the  sum  of  the  angular  velocity 
vectors  co  1  and  w  2 


This  vector  and  can  be  written  as  a  function  of  the  platform's  centerpoint  velocity  vector 
V  c  and  the  platform's  angular  velocity  vector  co 


3.4.3  Rigid  Body  Velocity  Analysis 

The  velocity  of  point  p,  Vp,  can  be  determined  by  using  equation  (1 1)  or  (17). 
Expressions  for  the  velocities  and  angular  velocities  of  the  rigid  bodies  in  the  connector 
model  must  also  be  found.  As  explained  in  Section  2.5,  the  connector  can  be  modeled  as 
the  system  shown  in  Figure  3.9.  All  the  rigid  bodies  in  the  connector  will  have  the  same 

orientation  and  therefore  the  same  angular  velocity  vector  w  12  • 

The  velocity  of  mass  M  b  is  only  a  function  of  the  angular  velocity  of  the  Hooke  joint 
(0 12  since  its  distance  from  the  base,  bl ,  is  constant.  The  velocity  of  this  rigid  body  can  be 
written  as 


(21) 


Wl2 


[(Yc*S2)  +  (0  •(Spc^S2)]        ,  [(Yc- §23)-^^  •(Rpc^S23)] 


§2  (22) 


Yb  =bl[(0i2xs  3] 


(23) 


Using  the  expression  for  the  angular  velocity  vector  02 12  given  in  equation  (22)  and  the 
definitions  for  the  unit  vector  s  2  and  s  23  ,  the  velocity  of  the  base  mass  can  be  written  as 

Yb  =  ^[(Yc-S2)  +  C0-(RpcXS2)]s2  + 

^  [(Yc-S23)  +  4!3-{Spc'^S23)]  §23  (24) 

The  velocity  of  mass  M  a  is  function  of  the  connector's  rotation  and  the  rate  of  change  of 
the  distance  D 

Vd=  053  +  0(0212x83)  (25) 

Using  the  expression  for  the  angular  velocity  vector  w  12  given  in  equation  (22)  and  the 
definitions  for  the  unit  vector  s  2  and  §  23  ,  the  velocity  of  the  decoupling  stage  mass  can  be 
written  as 

Yd=DS3+  ^[(Yc-S2)  +  W  •(RpcXS2)]  §2  + 

^  [(Yc-S23)+ii3-(Rpc''S23)]S  23  (26) 

The  velocity  of  the  mass  M  e  is  also  a  function  of  the  connector's  rotation  and  the  rate  of 
change  of  the  distance  E 

Ye  =   Es3  +  E(wi2  XS3)  (27) 

Using  the  expression  for  the  angular  velocity  vector  to  12  given  in  equation  (22)  and  the 
definitions  for  the  unit  vector  s  2  and  s  23  ,  the  velocity  of  the  connector  equivalent  mass 
can  be  written  as 


Ve=ES3+  E[(Vc-S2)  +  C0  •(Rpc'^S2)]  §2  + 


Figure  3.9  -  Complete  Connector  Model 
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3^  Acceleration  Analysis 
The  acceleration  and  angular  acceleration  (also  known  as  the  acceleration  state)  of  a 
rigid  body  such  as  the  platform  can  be  described  by  an  accelCTator  A  : 

Ao- (OX  Vo 
a 

where  w ,  a  are  the  angular  velocity  and  acceleration  vectors  of  the  rigid  body.  The 
vectors  V  o  and  A  o  are  the  velocity  and  acceleration  of  the  point  O  on  the  rigid  body 
coincident  with  the  point  of  reference.  The  accelerator  is  a  motor  [22]  where  the  directional 
part  m,  the  angular  acceleration  vector  a  in  this  case,  is  independent  of  the  origin.  The 
moment  part  of  the  motor  mo,  the  acceleration  vector  term  in  this  case 


Figure  3.10  -  Second  Order  Instantaneous  Kinematics 
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A  o  -  w  X  V  o,  changes  to  m  p  =  m  «  +  PQ  x  m  when  the  origin  is  moved  from  point  O 

to  point  p.  The  acceleration  of  the  centerpoint  of  the  platform  c  can  be  determined  by 
changing  the  origin  from  point  O  to  point  c  as  as  shown  in  Figure  3.10.  The  velocity 
vector  Yo  used  in  the  accelerator's  definition  will  also  change  with  the  relocation  of  origin 

to  point  c 

Vc  =  Yo-Cxio 

The  acceleration  of  the  centerpoint  can  be  determined  by 

Ac-40xVc  =  Ao-wxVo-Cxa 

Using  the  above  equation  for  the  velocity  Y  c ,  the  acceleration  of  point  c  can  be  written  as 


The  accelaation  of  the  point  where  the  connector  and  the  platform  are  joined  together,  point 
p,  can  be  determined  by  relocating  the  origin  from  point  c  to  point  p 


3.5.1  Connector  Acceleration  Analysis 

The  acceleration  of  point  p  can  be  written  as  as  a  function  of  the  velocities  and 
accelerations  of  the  individual  joints  that  make  up  the  HPS  manipulator  (see  Figure  3.7) 


Ac  =  Ao-cox[Cx(o]-Cxa 


(29) 


Ap  =  Ac  +  iOx[(OxRpc]  +  axR 


pc 


(30) 


6 


6  6 


Ap=I 


6 

2W2S2X£ 

j=3 


Using  the  line  coordinates  defined  in  section  3.4.1,  the  above  equation  can  be  simplified 


considerably 

Ap=WiSol  +  W2So2  + V3S3  +  a5i(s  iX  S  ol  )  +  w|  (  S  2  X  s  02)  + 

2(0iS  1  x(c02So2  +  V3S3I)  +  2CO2S2XV3S3  (31) 

3.5.2  Inverse  Acceleration  Analysis 

The  acceleration  vector  A  p  can  be  calculated  given  the  acceleration  of  the  platform 

center  point  c,  A  c,  and  the  angular  acceleration  vector  of  the  platform,  a  ,  as  outlined  in 

equation  (30).  The  joint  velocities  required  in  equation  (31)  were  determined  in  section 
3.4.  Therefore,  the  only  unknowns  inequation  (31)  are  the  joint  accelerations.  All  the 
known  terms  in  equation  (31)  will  be  grouped  into 

Aj  =  Ap-w](  s  1  X  Soi)-col(  S2X  §02)  - 

2(0iS  1  x((02So2  +  V3S3)  -  2(02S2XV3S3  (32) 

As  in  section  3.4.1,  the  line  coordinates  for  rotors  1  and  2  can  also  be  written  as 

s  oi  =  Ls  1  X  s  3  =  Ls  2  ;     s  o2  =  Ls  2  X  s  3  =  Ls  23 

Using  these  equations  for  the  line  coordinates,  equations  (3 1)  and  (32)  can  be  combined  to 
obtain  an  expression  for  the  unknown  joint  accelerations 

Ap=WiLS2  +  cb2LS23  +  V3S3  (33) 

A  unit  force  vector  acting  along  the  connector  itself  has  the  following  ray  coordinates 

§3 
0 

This  force  is  clearly  reciprocal  to  the  rotors  1, 2, 4, 5  and  6.  Forming  the  reciprocal 
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pnxluct  of  this  unit  force  with  equation  (33)  yields  the  following  expression  for  the 
acceleration  of  the  prismatic  pair  A  3 


A3  =  V3  =  AJ- s  3 


(34) 


A  unit  force  vector  acting  along  unit  vector  s  2  and  going  through  point  p  has  the  following 
ray  coordinates 


§2  = 


S2 

0 


This  force  is  clearly  reciprocal  to  the  rotors  2, 3, 4, 5  and  6.  Forming  the  reciprocal 
product  of  this  unit  force  with  equation  (33)  and  using  the  Une  coordinates  daived 
previously  yields  the  following  expression  for  the  angular  acceleration  a  1 


ai  =  coi  = 


Ap-S2 


(35) 


A  unit  force  vector  acting  along  unit  vector  s  23  and  going  through  point  "p"  has  the 
following  ray  coordinates 


§23  = 


§23 

0 


This  force  is  clearly  reciprocal  to  the  rotors  1, 3, 4, 5  and  6.  Forming  the  reciprocal 
product  of  this  unit  force  with  equation  (33)  and  using  the  line  coordinates  derived 

previously  yields  the  following  expression  for  the  angular  acceleration  a  2 


A  n  *  S  n 

a2=W2=  — '^j;^ — 


(36) 
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The  connector  angular  acceleration  vector  a  12  is  defined  as  [19] 

a  12  =  a  1  s  1  +  a2  §2  +  wi(02(  s  1  X  s 2I)  (37) 

3.5.3  Rigid  Body  Acceleration  Analysis 

As  explained  in  Section  2.6,  the  connector  can  be  modeled  as  the  system  shown  in 
Figure  3.7.  All  the  rigid  bodies  in  the  connector  will  have  the  same  orientation  and 

therefore  the  same  angular  velocity  vector  w  12  and  angular  acceleration  vector  a  12. 

The  acceleration  of  mass  M  b  is  only  a  function  of  the  angular  velocity  and  acceleration 
of  the  Hooke  joint,  co  12  and  a  12 ,  since  its  distance  from  the  base,  bl ,  is  constant.  The 
acceleration  of  this  rigid  body  can  be  written  as 

Ab  =  bl[ai2x  S3] +  bl[(0i2x  ((012X  S3)]  (38) 

Using  the  expressions  for  the  angular  velocity  w  12 ,  angular  acceleration    12  and  the 
definitions  for  s  2  and  s  23,  the  acceleration  A  b  can  also  be  written  as 

Ab  =  bl(ai  §2+  a2S23)  + 

bl[  2wiW2(si  •831)82  + w](s  1  •83)8  , -(co^  +  w|)s3]  (39) 

The  acceleration  of  mass  M  j  can  be  written  as 

Ad=D  S3  +  2D(  iai2X  S3)  +  D[ai2X  § 3]  +  D[(0i2 x  ((O12X  s 3)]  (40) 

Using  the  expressions  for  the  angular  velocity  w  12 ,  angular  acceleration  a  12  and  the 
definitions  for  s  2  and  s  23,  the  acceleration  A  j  can  also  be  written  as 


tJ.%  " 


46 

Ad=DS3+2b((OlS2  +  W2S23)+D(aiS2  +  a2S23)  + 

d[  2(0i(02(si  •§31)52  + wi(si  •S3)si-(to?  +  (o|)s3]  (41) 
The  acceleration  of  mass  M  e  can  be  written  as 

Ae=Es3  +  2E(  toi2x  S3l)  +  E[ai2x  S3]  +  E[40i2x  (wi2x  S3)]  (42) 

Using  the  expressions  for  the  angular  velocity  to  12 ,  angular  acceleration  a  12  and  the 
definitions  for  s  2  and  s  23,  the  acceleration  A  e  can  also  be  written  as 

Ae=ES3+2E(wiS2  +  t02S23)  +  E(aiS2  +  a2S23)  + 

e[  2wiW2(si  •  831)82  + w^(s  1  •S3)si-(to?  +  col)s3]  (43) 

3.6  Motion  Planning 
Path  planning  consists  of  describing  the  motion  of  a  given  point  of  a  manipulator. 
Motion  planning  describes  the  motion  of  a  given  point  and  the  orientation  of  the  end 
effector.  Enough  infomation  should  be  provided  in  ordCT  to  describe  the  desired  motion  for 
the  system.  Once  this  motion  is  determined,  the  position,  velocity  and  acceleration  of  the 
connectors  can  be  detCTmined  by  an  inverse  kinematic  analysis. 

3.6. 1  Motion  Planning  using  Screw  Theory 

As  outlined  in  Screw  theory  [20, 21, 22, 23)  the  instantaneous  motion  of  a  body  can  be 
described  by  the  rotation  about  a  screw  as  shown  in  Figure  3.11.  The  parameters  required 
to  describe  this  screw  are  the  axis  of  rotation  s,  the  pitch  h,  and  the  location  of  the  screw 
axis  with  respect  to  the  base  coordinate  frame  origin,  r  o-  The  displacement  of  a  point  p  on 
the  platform  coincident  with  the  point  of  reference  can  be  determined  using  the  screw 


parameters  and  an  angular  displacement  0  about  the  axis  of  rotation  of  the  screw 


APo  =  e[(roXs)  +  h§] 


(44) 


The  displacement  of  the  centerpoint  c  can  be  written  as 


A£  =  0[(rcxs)+  hs 


(45) 


The  new  location  of  the  centerpoint  c  after  the  rotation  6  is  given  by 


£new  =  £old+  0[(rcXS)  +  hs] 


(46) 


platform  i 
coordinate         ~ " 
system 


Instantaneous 
Screw 
Axis  (ISA) 


^  f 


system 


Figure  3.11-  Instantaneous  Motion  of  the  Platform 


The  displacement  of  any  point  on  the  platform  can  be  determined  by 
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AP  =  0[((rc-Rpc)'^s)  +  hs] 


(47) 


The  new  location  of  a  point  p  after  the  rotation  6  is  given  by 


Pnew=P  old+e[((rc-Rpc)^s)+hsJ 


(48) 


The  location  of  any  point  on  the  platform  can  be  also  written  in  terms  of  the  centerpoint 
position 


The  vector  Rpc  is  the  relative  position  vector  of  any  point  p  with  respect  to  the 
centerpoint  prior  to  the  rotation  6  and  it  is  a  function  of  the  dimensions  and  orientation  of 
the  platform. 

3.6.2.  Describing  the  Orientation  of  the  Platform 

The  relative  position  vector  Rpc  can  be  defined  in  terms  of  the  vector  Rpc/m  which  is 

the  relative  position  vector  described  with  respect  to  the  moving  coordinate  frame  attached 
to  the  platform  as  explained  in  section  3.3.  As  given  by  equation  (4),  R  pc  can  be  written 

as 


The  columns  of  the  3  x  3  matrix  in  the  above  equation  are  the  unit  vectors  that  describe  the 
orientation  of  the  platform  with  respect  to  the  a  fixed  coordinate  fi-ame.  This  matrix  is 
known  as  the  transformation  or  rotation  matrix  [R].  The  elements  of  this  matrix  change  as 

the  platform  moves.  The  change  of  the  orientation  caused  by  a  rotation  0  about  the  screw 


(49) 


ail 

Rpc= 


a  12  a, 3 

^22    ^23  Rpc/m 

a32  a33 
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axis  s(s=Sxi  +  Syi  +  Sxk)  can  be  determined  by 
[  X  nn  X  ni»     m  ]  new  =  [  X  m»  X  m> 


Zm]old[R] 


(50) 


Where  |  X  m,  Y  m,  Z  ml  old  is  the  orientation  of  the  platform  with  respect  to  the  fixed 
coordinate  frame  prior  to  the  rotation,  [  X  m,  X  m,  Z  ml  new  is  the  orientation  of  the 
platform  with  respect  to  the  fixed  coordinate  frame  after  the  rotation,  and  [R]  is  a  3  x  3 
rotation  matrix  given  by 


where  the  versine  function  is  vsn  0  =  1  -  cos  6.  This  rotation  matrix  [R]  describes  the 

change  of  orientation  of  a  rigid  body  caused  by  a  rotation  6  about  a  unit  vector  s  [18]. 

In  the  case  of  motion  planning  the  initial  orientation  of  the  platform  will  be  specified  by 
the  unit  vectors  X  m,  X  m  and  Z  m-  These  vectors  must  be  specified  according  to  the 
desired  initial  orientation  of  the  platform.  If  the  platform  is  being  used  in  a  machining 
operation,  the  initial  orientation  of  the  workpiece  with  respect  to  the  machine  tool  will  be 
the  initial  orientation  of  the  platform.  The  orientation  of  the  platform  is  subsequent 
locations  will  determined  using  equations  (50)  and  (51). 

The  premultiplication  of  the  relative  position  vector  by  the  rotation  matrix  is  equivalent 
to  the  second  term  of  equation  (49) 


The  relative  position  vector  R  pc  used  in  the  left  hand  of  the  equation  is  the  vector  before  the 
rotation  6. 


Sx^vsne  +cos6        Sx  SyVsnB  -  Sz  sin6   Sx  SzVsnO  +  SySinO 
[R]=  Sx  Sy  vsn0  +  Sz  sin0       Sy^vsnO+cosO      Sy  SzVsnO  -  SxSinO 
Sx  Sz  vsn6  -  Sy  sin6     Sy  Sz  vsn6  +  Sx  sin6  Sz^vsn0+cos6 


(51) 


-0(Rpc''s)  =  f  R]Rpc/m 
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3.6.3  Motion  Generation 

The  position  of  any  point  on  the  platform  can  be  determined  by  using  equation  (48) 

Pnew=Pold+e[((rc-Rpc)xs)+hs]  (48) 

The  velocity  of  any  point  can  be  determined  using  equations  (8)  and  (1 1) 

Yp  =  (o[((rc-Rpc)xs)  +  hs]    .    .  (52) 

The  acceleration  of  any  point  on  the  platform  can  be  determined  by  using  equations  (29) 
and  (30) 

Ap  =  Ao  + wx[(rc-Rpc)x  w]  +(rc-Rpc)xa  (53) 

where  0,  to  and  a  are  the  angular  displacement,  velocity  and  acceleration  vectors  of  the 
platform  and  are  related  by 

CO  =  f-  ;  a  =  ^  = 
-     dt  dt  dt2 

If  the  screw  axis  s  remains  fixed  during  the  motion,  which  is  the  case  in  simple  motions 
such  as  translation  and  rotation,  the  angular  velocity  and  acceleration  can  be  written  as 

CO  =  ;  a  =  ^  s  =  -i^Os 
~     dt  "  dt  ~      dt2  " 

A  simple  way  to  describe  the  motion  of  the  platform  is  by  using  a  continuous  time 
function  for  the  angular  displacement  such  as  a  cycloidal  motion  curve  used  for  designing 
cam  displacement  profiles  [24].  This  will  assure  that  the  angular  velocity  and  acceleration 
vectors  will  also  be  continuous  functions.  The  angular  displacement  function  to  be  used  is 
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0(t)  =  ^[l-cos(^)]s  (54) 

where  A0  is  the  total  angular  displacement  (in  radians)  and  T  is  the  total  period  or  the  time 
required  to  complete  the  desired  motion.  The  angular  velocity  and  acceleration  vectors, 
CO  (t)  and  a  (t),  are  determined  by  the  time  derivatives  of  the  angular  displacement  function 


w(t)  =  ^0^[sin(^l)]s  (55) 


a(t)  =  ^fijt2fcos(^)l  s  (56) 
2x2  L      \  T  /J 


3.6.4  Rectilinear  Motion 

Rectilinear  motions  of  the  platform  can  also  be  described  using  screw  theory.  The 
orientation  of  the  platform  is  fixed  which  make  the  angular  velocity  and  angular 
accelerations  zero.  For  this  type  of  motion  it  is  said  that  the  axis  of  rotation  is  located  at 

infinity,  which  is  specified  by  setting  the  angular  rotation  0  to  0,  the  radius  of  rotation 

r  o  =*  °°,  and  the  pitch  h  =»  oo.  The  product  of  the  angular  rotation  and  the  pitch  can  be 
written  as 


he  =  s 


where  S  is  the  translational  displacement  of  the  platform.  The  axis  of  translation  w  ,  which 
is  parallel  to  the  axis  or  rotation  s,  is  now  used  to  describe  the  direction  of  translation  of  the 
platform.  The  displacement  of  any  point  on  the  platform  can  now  be  written  as 

AP=  hSw  =Sw  (57) 


The  product  of  the  rotational  velocity  and  the  pitch  can  be  written  as 


hto  =  Vt 
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where  V  t  is  the  translational  velocity  along  the  vector  w.  Using  the  above  equation  and 
equation  (52),  the  velocity  of  any  point  on  the  platform  can  now  be  written  as 

Vp=  htow  =Vtw  (58) 
The  acceleration  of  any  point  on  the  platform  can  now  be  written  as 

Ap=Ao=^hww  =Atw  (59) 

where  A  t  is  the  translational  acceleration  along  the  vector  w. 

The  translational  displacement  can  be  described  by  a  time  function  similar  to  the  one 
employed  for  the  angular  displacement 

S(t)  =  ^[l-cos(^)]  (60) 

where  AS  is  the  total  translational  displacement,  and  T  is  the  time  paiod  required  to 

complete  the  motion.  The  translational  velocity  and  acceleration  can  be  determined  by 
taking  the  time  derivatives  of  the  displacement  function 


Vt(t)  =  ^^sin(3t)  (61) 


At(t)  =  ^^(^f  cos(^l)  (62) 


3.6.5  Motion  Planning  for  Machining  and  Mirror  Polishing 

Rectilinear  motion  is  a  typical  motion  used  when  machining  a  workpiece.  In  this  case 
the  motion  can  be  determined  by  using  equations  (48)  and  (57)  through  (62).  The 
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center  of 
rotation 


Figure  3.12-  Platform  Rotation  about  a  given  axis  s 

parameters  that  have  to  specified  are  the  displacement  AS,  the  period  T  and  the  axis  of 
translation  w  . 

Another  possible  motion  is  when  the  platform  has  to  follow  a  curve  while  remaining 
tangent  to  the  curve  at  all  times.  Such  a  motion  is  used  to  polish  a  mirror  or  machine  a 
cylindrical  part.  This  type  of  motion  can  be  described  as  a  rotation  of  the  platform  about  an 
axis  of  rotation  s  that  is  at  a  distance  rc  from  the  platform's  center  point  and  perpendicular 
to  the  axis  Z  m  as  shown  in  Figure  3.12.  The  platform's  motion  can  be  determined  by 
using  equations  (48)  and  (54)  through  (66).  The  parameters  required  for  planning  this 
motion  are  the  platform's  initial  location,  the  axis  or  rotation  r,  distance  r  c  from  the 

centerpoint,  the  total  angular  displacement  A0,  and  the  period  T.  For  this  type  of  motion 
the  position,  velocity  and  acceleration  of  any  point  on  the  platform  are  given  by 

P  =  Po  +  [R]Spc/m  (63) 
Yp  =  (o[(rc-Rpc)xs]  (64) 

Ap=  cox[(rc-Rpc)x  w] +  (rc-Rpc)xa  (65) 


CHAPTER  4 

MANIPULATOR  FORCE  AND  TORQUE  ANALYSIS 

In  order  to  derive  the  equations  of  motion  of  the  manipulator,  it  is  necessary  to  perform 
a  complete  force  and  torque  analysis.  This  analysis  determines  the  resultant  forces,  F  j, 
and  the  resultant  torques,  T  j,  acting  on  each  body  of  the  system.  In  addition,  the 
force/torque  analysis  also  determines  the  static  capability.  The  issues  of  stability  and 
actuator  requirements  are  also  examined. 

A  rigid  body  may  experience  forces  and  torques  of  the  following  types 

-  External :  These  are  caused  by  external  sources  such  as  actuators  and  disturbances. 

-  Contact :  These  are  generated  by  the  contact  with  other  rigid  bodies  or  passive  elements 

such  as  springs  and  dampers. 

-  Field:  These  are  created  by  the  action  of  a  field  such  as  a  magnetic  force  or  gravity. 

-  Inertial :  These  are  the  result  of  the  rigid  body's  angular  velocity,  and  the  linear  and 

angular  acceleration. 

The  resultant  force  vector,  Fj,  and  the  resultant  torque  vector,  T  j,  acting  on  each  body 
in  the  system  produce  a  change  of  the  dynamic  state  of  the  system  which  is  described  by 
the  position,  velocity  and  acceleration  vectors.  All  the  forces  and  torques  acting  on  the 
platform  are  shown  in  Figure  4.1.  This  model  does  not  include  the  connector  model 
components  (as  outlined  in  Chapter  2 )  which  will  be  considered  later.  The  system  shown 
in  Figure  4.1  is  a  complete  model  when  the  connectors  are  modeled  as  rigid,  massless 
bodies. 

4. 1  Platform  External  Forces  and  Torques 

The  external  force,  F  ext,  and  torque,  T  ext,  applied  to  the  platform  are  determined  by 
the  use  or  application  of  the  platform.  One  possible  application  is  to  use  the  platform  as  the 
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Figure  4.1  -  Platform  with  Applied  Forces  and  Torques 

base  for  a  work  piece  in  a  machining  op^ation;  another  possibility  is  to  use  the  platform  to 
control  the  contact  force  with  a  surface  such  as  when  polishing  a  mirror.  The  equivalent 
force  and  torque  generated  by  the  external  force  and  torque  about  the  center  point  c,  which 
is  assumed  to  be  coincident  with  the  center  of  gravity,  are  given  by  the  following  equations 

Ec  =  Eext     ;   Tc=Text+  (Sec  ^  Eext)  (1) 

where  R  ec  is  the  relative  position  vector  from  the  centerpoint  of  the  platform  to  the  line  of 
action  of  force  Fext,  as  shown  in  Figure  4.2.  These  equations  can  be  expanded  to 
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Any  force  /  torque  combination  acting  on  a  rigid  body  can  be  combined  into  a  dual  vector 
quantity  called  a  wrench,  W  and  the  external  force  and  torque  acting  on  the  platform,  with 

the  colter  point  c  as  the  reference  point,  can  be  combined  into  an  external  wrench  W  ext: 


Wext  = 


£.ext 


Text  +  (Sec  ^  Eext  ) 


(3) 


4. 1  ■  1  External  Forces  and  Torques  in  Mirror  Polishing 

'     One  possible  use  of  the  platform  is  to  control  the  contact  force  between  the  end  effector 
and  a  surface.  An  example  of  such  application  is  polishing  a  mirror  or  glass.  In  this  case 
the  end  effector  will  support  some  polishing  material  which  will  be  moved  about  the 
surface  using  the  manipulator  while  at  the  same  time  the  contact  force  is  kept  below  a  safe 
limit  to  avoid  any  surface  damages.  The  movable  platform  must  be  tangential  to  the  surface 
at  all  times  while  applying  a  normal  or  contact  force  as  shown  Figure  4.3 


Figure  4.2  -  External  and  Gravitational  Forces  &Torques  acting  on  the  platform 
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There  are  two  forces  apphed  to  the  platform,  the  first  is  the  normal  force  Fq  caused  by  the 

contact  between  the  poUshing  material  and  the  mirror  surface.  This  force  vector  is  the 
perpendicular  to  the  platform  and  in  the  opposite  direction  of  the  unit  vector  Z  m-  Since  the 

normal  force  vector  intersects  the  centerpoint  it  does  not  produce  a  torque.  The  second 

force  vector  is  a  friction  force  F  fr  and  it  is  caused  by  the  friction  between  the  polishing 

material  and  the  miiror  surface.  This  force  is  a  function  of  the  normal  force  Fq  and  the 

coefficient  of  friction  p.  Clearly  it  is  tangent  to  the  mirror  surface  and  it  is  always  opposite 
to  the  direction  of  travel,  which  is  described  by  the  vector  t  as  shown  in  Figure  4.4. 


direction  of  travel 
Figure  4.3  -  Mirror  polishing  task 


Figure  4.4  -  Mirror  polishing  forces 


When  the  platform  is  rotating  about  a  given  axis  s,  the  direction  of  travel  is  given  by  (  see 
section  3.6 ) 


t  =  Zm  "  S 


If  the  platform  is  following  a  pure  translational  motion,  the  direction  of  travel  is  given  by 
the  vector  w  ( see  Section  3.6 ).  Since  the  line  of  action  does  not  intersect  the  centerpoint  c 
( see  Figure  4.4 )  it  produces  a  torque  which  is  given  by 

Tfr  =  aZm"  Ffr 

The  external  wrench  applied  to  the  platform  during  the  mirror  polishing  task  is  therefore 


Wext  = 


-Fn{Zn,  +  |Ut) 
aZm''  (-Fnlit) 


(4) 


4.1.2  External  Forces  and  Torques  in  Machining 

One  of  the  most  promising  appUcations  of  the  platform  is  in  machining  operations, 
where  the  workpiece  is  positioned  and  presented  orientated  by  the  moving  platform  to  the 
cutter  as  shown  in  Figure  4.5.  The  advantage  is  that  the  system  is  stiffer  when  using  a 
platform  over  a  conventional  machine  tool .  This  offers  the  possibiUty  of  machining 
complex  geometries  with  higher  precision  and  greater  material  removal  rates  than  what  is 
possible  with  conventional  multiaxis  machine  tools. 

In  general  the  forces  developed  in  machining  are  somewhat  complex  to  describe  since  it 
depends  on  many  diverse  factors  such  as  the  velocity  of  cutting,  the  thickness  of  the  cut, 
the  material  being  cut  and  the  number  of  teeth  of  the  cutter  among  other  things  [25].  For 
simplicity  a  full  groove  cut  with  a  four  tooth  cutter,  as  shown  in  Figure  4.6,  will  be 
considered.  Each  tooth  will  be  loaded  with  a  cutting  force  when  inside  the  cutting  area 
which  the  arc  between  points  e  and  d  of  Figure  4.6.  The  force  applied  to  the  platform  is  a 
combination  of  the  individual  loads  on  each  tooth.  As  shown  in  Figure  4.7  the  tooth 
cutting  force  can  be  divided  into  a  component  perp«idicular  to  the  cutting  surface,  the 
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normal  force,  and  a  component  tangential  to  the  cutting  surface  which  is  given  by 


Ft  =  Ksb  Fr  sin(j) 

where  K  s  is  the  specific  stiffness,  b  is  the  depth  of  cut,  Fr  is  the  feed  rate  and  (J)  is  the  angle 
shown  in  Figure  4.6.  The  tangential  forces  for  the  four  teeth  shown  are  given  by 

Fti  =  KsbFrsin(|) 


Ft2  =  KsbFr  sin  ((J) +  90°) 
Ft3  =  KsbFrsin((|)+  180") 
Ft4  =  KsbFr  sin  (({)+ 270°) 


The  cutting  force  of  a  tooth  becomes  zero  when  it  is  not  touching  the  cutting  surface.  The 
resultant  force  applied  to  platform  is  the  sum  of  all  the  cutting  forces.  In  a  full  groove  cut 
the  force  components  perpaidicular  to  the  direction  of  travel  cancel  out  and  the  resultant 
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Figure  4.5  -  Machining  with  a  platform 
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Figure  4.6  -  Top  view  of  a  four  tooth  cutter  in  a  full  groove  cut 


force  polygon 


Figure  4.7  -  Cutting  forces 


cutting  force  is  a  constant  along  the  direction  of  travel 


E  cutting  =  K  s  b  Fr  t 


where  the  direction  of  travel,  t,  was  determined  in  the  previous  section.  This  force  acts  in  a 


61 

plane  parallel  to  the  platform  at  a  distance  a  from  the  centerpoint  of  the  platform  as  shown 
in  Figure  4.5.  The  normal  force  shown  in  this  figure  is  zero  since  the  end  mill  or  cutter  is 
machining  the  workpiece  with  the  sides  of  the  cutter,  therefore  all  the  cutting  forces  are  in  a 
plane  parallel  to  the  platform. 

The  external  wrench  applied  to  the  platform  during  the  full  groove  cut  is 


Wext  = 


-KsbFrt 
aZm"  (-KsbFrt) 


(5) 


A  more  complex  description  of  the  machining  external  wrench  is  required  for  other  type  of 
cuts  and  also  to  include  the  effects  of  machine  tool  chatter  [25]. 


4.2  Gravitational  Forces  and  Torques 

The  gravitational  force  and  torque  vectors  acting  on  the  platform  are  given  by  ( see 
Figure  4.2 ) 


Fg  =  -Mpg 


&.     Tg  =  Reg  X  Fg 


where  R  eg  is  the  relative  position  vector  of  the  platform's  center  of  gravity  respect  to  the 
centerpoint  of  the  platform.  This  equation  can  be  also  written  as 
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(6) 


where  M  p  is  the  mass  of  the  platform.  The  gravitational  torque  acting  on  the  platform  is 

zero  since  the  reference  point  to  be  used  on  the  platform,  c,  is  coincident  with  the  center  of 
gravity  of  the  platform.  The  location  of  the  reference  point  c  at  the  center  of  gravity  makes 
the  position  vector  Reg  =  0.  The  gravitational  effects  on  the  platform  will  be  described  by 

a  gravitational  force 
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4.3  Connector  Forces  and  Torques 
Each  of  the  connectors  applies  an  effective  force  F  l  to  the  platform  at  its  corresponding 

connection  point  with  the  platform  as  shown  in  Figure  4.8.  This  force  is  generated  :^me 
of  the  connector  components.  How  the  connector  exactly  generates  this  force  will  be 
discussed  later.  When  the  connector  is  assumed  to  be  a  rigid  massless  body,  the  effective 
force  El  is  the  force  generated  by  the  linear  actuator  located  on  each  connector.  Each 
connector  force  has  a  magnitude  of  F  l  and  acts  along  the  corresponding  line  s  3  which  is  at 
a  distance  R  pc  from  the  platform's  center  ( as  an  example  the  distance  R  pc  for  connector  2, 
R2c>  is  shown  in  Figure  4.3 ).  The  coordinates  for  each  applied  force  are  given  by 

Fl=FlS3      &     1l  =FL(Rpc''S^)  (8) 
Which  can  also  be  combined  into  the  dual  vector  form 


Figure  4.8  -  Connector  Forces  acting  on  the  Platform 
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Wl=Fl 


§3 
Spc    S  3 


(9) 


These  applied  forces  can  be  combined  into  the  resultant  connector  wrench  given  by 
Wi  =  (WL)l+  (Wl)2+  (Wl)3+  (Wl|)4+  (Wl)5+  (Wl)6  (10) 

which  can  also  be  written  as 

Wri  =  [Jm]{FL}  (11) 

where  [J  nJ  is  Manipulator  Jacobian,  and  {Fl}  is  the  connector  force  column  matrix 

{EL}  =  [(FL)l,(FL)2,(FL)3,(FL)4,(FL)5,(FL)6]'r.  The  Jacobian  [J  nJ 
can  be  written  as 

[JnJ  =[(si)i  (s)2  (s)3  (1)4  (sjs  die]  (12) 

where  each  column  of  the  Jacobian  Matrix  are  the  Pliicker  line  coordinates  of  a  connector 
(  see  Section  3.3.1 ) 


pc' 

4.4  Platform  Resultant  Forces  and  Torques 
The  resultant  wrench  Wp  acting  upon  the  platform  is  the  sum  of  the  resultant  connector 
wrench  Wrf,  the  external  wrench  W  ext  and  the  gravitational  force  Wg 
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This  resultant  wrench  produces  the  inertial  force  F*p  and  torque  T*p  acting  upon  the 
platform 

F*p=-MpAc;  i;  = -[(a  •  Ip")  +  (co  X  Ip".  (ol)]  (14) 

where  Mp  is  the  mass  of  the  platform;  Ac  is  the  acceleration  of  the  center  of  gravity;  is 

the  angular  acceleration  of  the  platform;  to  is  the  angular  velocity  of  the  platform;  and  Ip" 

is  the  Inertia  Dyadic  of  the  platform  about  the  center  of  gravity.  The  static  solution  for  the 
platform  can  be  obtained  by  using  equation  (13)  and  by  setting  the  resultant  wrench  to  zero 

WrL+  Wext+  Wg  =  0  (15) 

4.5  System  Singularities 
The  resultant  wrench  can  be  calculated  given  the  inertial  parameters  of  the  platform  M  p 
and  Ip",  the  centerpoint  acceleration  vector  A  c,  and  the  angular  acceleration  and  velocity 

vectors  a  and  w  which  are  determined  by  the  motion  planning  process  as  outlined  in 

Section  3.6.  When  the  external  and  gravitational  wrenches  are  known,  equation  (13)  can 
be  rearranged  to  determine  the  connector  force  matrix  {F  l}  required  to  generate  the  desired 

resultant  platform  wrench 

[JnJ  (El)  =  Wp  -  Wext  -  Wg  (16) 

This  is  a  system  of  6  equations  with  the  connector  forces  as  the  6  unknowns:  ( F  l  )  i , 
(Fl)2,(Fl)3,(Fl)4,(Fl)5,(Fl)6-  Premultiplying  equation  ( 1 6)  by  the  inverse 
of  the  Manipulator's  Jacobian  ,  [J  nJ     yields  the  following  expression  for  the  connector 
force  matrix 

(El)  =  [JmJ'MWp  -  Wext  -  Wg)  (17) 
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If  the  above  equation  cannot  be  solved  or  the  required  connector  forces  calculated  by  the 
above  equation  exceed  the  physical  limits  of  the  system  ,  the  planned  motion  cannot  be 
generated  and  the  system  is  said  to  be  degenerate  or  singular. 

4.5. 1  Geometric  Singularities  ,  < 

When  the  det  [  J  nJ  =  0,  it  is  not  possible  to  obtain  the  invCTse  of  the  Jacobian  matrix, 
and  therefore  the  above  equation  cannot  be  solved.  The  rank  of  [  J  ml  is  less  than  six  and 
the  system  of  equations  formed  by  the  product  F  l  [J  ml  is  not  an  independent  set  of 
equations.  The  columns  of  [  J  nJ  have  become  linearly  dependent  which  implies  that  the 
connector  line  coordinates  have  become  hnearly  dependent  In  practice  the  connector 
forces  cannot  equilibrate  the  applied  wrench.  The  actuator  magnitudes  will  have  to  be  set  to 
infinitely  large  values  and  the  actuators  will  saturate  in  the  process.  When  this  situation 
arises  the  platform  is  said  to  be  in  a  degenerate  or  singular  configuration  (position  and 
orientation).  This  type  of  singularity  will  be  defined  here  as  a  geometric  singularity,  since 
it  is  a  function  of  the  geometry  of  the  connector  lines. 

It  is  important  at  the  outset  to  determine  the  location  of  the  geometric  singularities,  and 
to  avoid  them  when  planning  a  motion.  It  is  desirable  that  the  working  volume  of  the 
workspace  used  for  a  proposed  application  does  not  include  any  geometric  singularities. 

It  is  clear  that  as  the  platform  approaches  a  singularity,  the  connector  forces  will  reach 


very  high  values  (Fl)i  =  (Fl)2  =  (Fl)  3  =  (Fl)4  =  (Fl)5  =  (Fl)6=*°°-  Clearly 


this  is  physically  impossible,  and  the  actuators  which  generate  the  connector  forces  will 


In  this  case,  the  desired  resultant  wrench  will  be  different  from  the  actual  resultant 


wrench.  This  wrench  Wp  is  determined  by  setting  F  l  to  F  max  iri  equations  (13): 


saturate 


{Fa}      {Fa max}  =  [Faimax 


,  Fa  2max,  Fa  3max,  Fa  4max,  Fa  5max,  Fa  6max  ]^ 


Wp  =  [Jm]  <F 


max  / 


)  +  w 


VLext 


(18) 
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Since  the  actual  resultant  wroich  is  not  equal  to  the  desired  resultant  wrench  ,  the 
platform's  actual  acceleration  and  angular  acceleration  vectors  will  be  different  from  those 
required  by  the  planned  motion.  The  platform  will  not  be  able  to  follow  the  planned  motion 
and  the  system  will  be  out  of  control  or  uncontrollable  as  it  approaches  a  singularity. 

The  geometric  singularities  depend  on  the  geometry  and  location  of  the  platform.  The 
geometry  is  detamined  by  the  dimensions  and  configuration  of  the  manipulator.  The 
location  of  the  platform  is  specified  by  the  center's  position  vector  C;  and  the  orientation 
which  is  described  by  using  the  3x3  rotation  matiix  [R]  as  explained  in  Section  3.3. 
Therefore  the  geometric  singularities  can  be  avoided  by  modifying  the  motion  planning 
parameters  (  see  Section  3.6 ).  ~ 

4.5.2  Actuator  Singularities  .     f  ; 

The  platform  can  also  become  uncontrollable  in  a  nonsingular  location  when  one  or 
more  of  the  required  connector  forces  exceed  the  allowed  maximum  connector  forces,  i.e. 
{El}  >{  Fmax }.  In  this  situation  the  saturating  actuators  will  operate  at  their  maximum 
force.  The  actual  resultant  wrench  will  of  course  be  different  from  tiie  desired  or  required 
wrench,  and  the  motion  of  the  platform  will  deviate  from  the  desired  motion  profile. 

The  power  required  from  each  individual  connector  can  be  calculated  by  the  following 
scalar  product  (power  is  a  scalar  quantity) 

Power  =[  Fa- Vp]  (19) 

where  F a  is  the  actuator  force  and  V  p  is  the  connector's  endpoint  velocity.  When  the 
required  power  from  any  of  the  actuators  exceeds  its  maximum  capacity,  the  desired 
platform  motion  cannot  be  generated.  A  similar  problem  will  arise  whenever  the  required 
actuator  speed  of  response  or  bandwidth  exceeds  the  maximum  bandwidth  of  the  actuator. 
In  general,  whenever  the  required  forces  cannot  be  generated  by  the  actuators  and  the 
system  is  in  a  nonsingular  location,  the  system  is  said  to  be  in  a  actuator  singularity. 
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Actuator  singularities  create  similar  problems  as  the  geometric  singularities  but  are  caused 
by  the  force,  power  and/or  bandwidth  limitations  of  the  actuators. 

Whenever  the  platform  is  in  a  singularity  (either  a  geometric  or  an  actuator  singularity), 
the  desired  motion  cannot  be  generated  and  its  said  that  the  system  is  out  of  control  or 
uncontrollable.  The  platform's  motion  is  altered  or  degraded.  A  consequence  of  a 
singularity  is  that  the  motion  genraated  will  be  different  from  the  planned  one.  A  serious 
consequence  of  a  singularity  is  that  the  change  in  motion  might  lead  the  platform  to 
subsequent  singular  locations.  In  this  case  the  system  does  not  recover  from  the  singularity 
and  the  platform  will  become  unstable  and  totally  out  of  control. 

4.6  Connector  Force  Analysis 
As  mentioned  before  each  connector  applies  a  force  to  the  platform.  If  the  connector  is 
modeled  as  a  rigid  massless  body,  the  connector  force  will  be  generated  by  the  Unear 
actuator.  When  more  complete  models  are  considered,  the  connector  force  also  depends  on 
the  system  parameters  (stiffness  and  damping),  displacement  and  velocity.  In  order  to 
generate  the  dynamic  model,  expressions  for  the  connector  forces,  and  the  forces  applied  to 
each  of  the  rigid  bodies  in  each  connector  must  be  obtained.  The  complete  connector  model 
is  discussed  in  Section  2.5.  The  first  body  on  each  connector  is  the  equivalent  mass  M  e , 
the  second  body  on  each  connector  is  the  decoupUng  stage  mass  M  d ,  and  the  third  is  the 
actuator  base  mass  M  b- 

4.6. 1  External  Forces  and  Torques 

The  only  external  force  acting  on  M  g  is  the  actuator  force  Fa,  as  shown  in  Figure  4.9. 
The  torque  is  zero  since  it  is  assumed  that  its  line  of  action  intersects  the  center  of  gravity  . 
The  external  force  acting  upon  M  e ,  F  (ext.  e) ,  is  given  by 


F(ext,e)  =  Fa 


(20) 


68 

4.6.2  Contact  Forces  and  Torques 

There  are  two  contact  forces  acting  on  M  e ,  F  ct  and  F     as  shown  in  Figure  4.9. 

F  icL  is  produced  by  the  deformation  of  K  l-  F  ct  is  generated  by  the  friction  of  the  actuator 

and  transmission  which  is  modeled  as  a  viscous  damper  with  of  damping  coefficient  C  t. 

The  torque  produced  is  zcto  since  the  line  of  action  of  all  these  forces  intersects  the  center 
of  gravity  of  the  mass.  The  contact  force  acting  upon  M  e ,  F  (c,  e) .  is  given  by 

F(c.e)  =  -[Fct +FkL]  (21) 
whffe  the  forces  F  ct  and  F    are  given  by 

Fct  =  CtE;  FkL=  Kl6l  (22) 
where  6  l  is  the  deformation  of  K  l  and  is  given  by 

6l  =  (E-H)-1lo  (23) 

where  1  lo  is  the  free  length  of  K  l- 

There  is  are  two  contact  forces  acting  on  the  decoupling  stage  mass  M  a,  F  cd  and 
F  kd  as  shown  in  Figure  4. 10.  F  kd  is  produced  by  the  deflection  of  K  d  •  F  cd  is  generated 
by  the  friction  of  viscous  dampo-  C  d-  The  torque  is  zero  since  all  the  forces  go  through  the 
center  of  gravity.  The  contact  force  acting  upon  M  d ,  F  (c,  d) .  is  given  by 

F(c.d)  =  -[Fcd+Fkd]  (24) 


where  the  forces  F  kd  and  F  cd  are  given  by 

Fcd=Cd(b-L); 


Fkd=  Kd6d 


(25) 


Free  Body  Diagram 


Fct  Fa 

Figure  4.9  -  Forces  acting  upon  M  e 

Free  Body  Diagram 


/  Fed 

Figure  4. 10  -  Forces  acting  upon  M  a 

where  6  d  is  the  deformation  of  the  decoupUng  stage  stiffness  and  is  given  by 

6d=D-ldo 


(26) 


where  1  do  is  the  free  length  of  the  decoupling  stage  support. 

There  are  two  contact  forces  acting  on  the  base  inertia  M  b ,  F  ct  and  F  r  as  shown  in 
Figure  4.10.  Fr  is  a  workless  constraint  caused  by  the  rigid  rod  connection  to  the  base. 
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Fct  is  generated  by  the  friction  of  the  actuator  and  transmission  which  is  modeled  as  a 
viscous  damper  with  a  damping  coefficient  C  t-  The  torque  produced  by  these  contact 
forces  is  zero  since  their  Une  of  action  intersects  the  center  of  gravity.  The  contact  force 
acting  upon  M  b ,  F  (c,  b) .  is  given  by 

F(c.b)  =  [Fct-Fr]  (27) 

4.6.3  Field  Forces  and  Torques 

The  only  field  force  acting  on  the  rigid  bodies  of  the  connector  is  gravity  as  shown  in 
Figures  4.9, 4. 10  and  4.11.  The  gravitational  torques  are  zero  since  the  point  selected  for 
the  sum  of  forces  on  each  body  is  its  center  of  gravity.  The  gravitational  forces  are 

F(g.e)  =  -[Meg]k  (28) 
F(g,d)  =  -iMdgJk  (29) 
F(g.b)  =  -[Mbg]k  (30) 


Free  Body  Diagram 


Figure  4.11-  Forces  acting  upon  M  b 


4.6.4  Resultant  Forces  and  Torques 

The  resultant  force  and  torque  acting  on  each  of  the  bodies  of  the  connector  is  the 
combination  of  the  external  forces/torques,  the  contact  forces/torques  and  the  field 
forces/torques.  The  resultant  torques  is  zero  since  the  external,  contact  and  field  torques 
are  zero.  The  resultant  force  vectors  for  the  rigid  bodies  on  each  connector  are  given  by 

Fe  =  [Fa -CtE -Kl6l]  S3-[Meg]k  (31) 
Fd=  [-Cdi(D-L)  -KdSj  S3-[  Mdg]k  (32) 
Fb  =  [c,E-Fr]s3-[Mbg]k  (33) 

4.6.5  Additional  Equations 

In  order  to  completely  describe  the  behavior  of  the  connector,  some  additional  force 
equations  have  to  be  derived.  The  platform  is  joined  to  the  connector  by  the  coupling 
stiffness  and  damper,  and  by  the  decoupling  damper  as  shown  in  Figure  4.12.  The 
connector  force  F  l  is  produced  by  the  damping  elements  C  d ,  C  c  and  by  the  stiffiiess 

element  Kc 

El  =[Fcd+  Fcc+  Fkc]s3  (34) 

where  F  cd  is  the  ftictional  force  of  the  decoupling  stage  damper  C  d ;  F  cc  is  the  frictional 
force  of  the  coupling  stage  dampo-  C  c ;  and  F  cc  is  the  spring  force  of  the  coupling  stage 
spring  K  c .  These  are  given  by 

Fcc=Cc(H-l);   Fkc=Kc6c  (35) 
where  6  c  is  the  deflection  of  the  coupling  stage  stiffness  and  is  given  by 
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§3 


Free  Body  Diagram 


/Fed  i 

Figure  4.12  -  Connector  Force  and  Free  Body  Diagram 


Free  Body  Diagram 


Figure  4.13  -  Forces  acting  at  the  connection  between  the  connector  and  coupling  stage 

6c=  (H-L)  -  U  (36) 

where  1  co  is  the  free  length  of  the  coupling  stage  spring.  The  forces  acting  at  the 
connection  of  the  coupling  stage  and  the  connector  itself  are  shown  in  Figure  4. 13.  The 
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balance  of  forces  is  given  by 


FkLS3  =  [  Fcc+  Fkc  |S3 


(37) 


An  expression  relating  the  connector  force  F  l  and  the  force  required  to  deform  the 


4.6.6  Force  Analysis  for  the  Simple  Connector  Model 

As  explained  in  Section  2.2,  the  connector  can  be  modeled  in  different  ways.  For  the 
complete  leg  model,  the  force  analysis  is  given  by  equations  (31),  (32),  (33)  and  (34). 

The  most  simple  model  is  obtained  by  assuming  that  the  connector  is  a  rigid  and 
massless  body.  In  this  model  the  connector  force  is  generated  by  the  actuator.  A  more 
complete  model  is  obtained  by  including  the  stiffness  of  the  connector  and  the  actuator's 
internal  friction.  In  this  connector  model  the  decoupling  stage  is  deactivated  by  setting  the 
decoupling  damping  coefficient  to  a  very  low  value  (C  d  =  0).  The  coupling  stage  is 

deactivated  by  setting  the  coupling  damping  coefficient  to  a  very  high  value  as  discussed  in 
Section  2.5  ( C  d  =*  °° ).  This  means  that  this  displacement  H  is  equal  to  the  connector 

length  L  minus  a  fixed  length  which  is  the  free  length  of  the  coupling  stage  spring  K  c , 
1  CO ,  and  its  first  time  derivative  is  zero.  In  this  case  the  resultant  forces  acting  upon 
masses  M  e  and  M  b  remain  the  same.  The  resultant  force  acting  upon  mass  M  d ,  which  is 
given  by  equation  (32),  is  modified  to 


The  connector  force  vector ,  which  is  given  by  equation  (38),  can  now  be  written  as 


connector  can  obtained  by  combining  equations  (23),  (25),  (34)  and  (37) 


Kl6lS3  =  Fl  -Cd(D-Ll)s3 


(38) 


(39) 


Fl  =Kl6lS3 


(40) 
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4.6.7  Force  Analysis  for  the  Low  Frequency  Model 

Another  model  that  can  be  used  is  the  one  that  describes  the  connector's  low  frequency 
mode  of  operation  (  see  Section  2.5  ).  In  this  model,  the  coupling  stage  is  active  while  the 
decoupling  stage  is  deactivated  by  setting  the  decoupling  damping  coefficient  to  a  very  low 

value  ( C  d  =»  0).  In  this  case  the  resultant  forces  of  masses  M  e  and  M  b  remain  the  same. 
The  resultant  force  acting  upon  mass  M  d ,  which  is  given  by  equation  (32),  is  modified  to 


The  connector  force  vector ,  which  is  given  by  equation  (38),  can  now  be  written  as 


This  connector  model  is  used  when  the  system  velocities  are  low  and  there  are  no 
disturbances  applied  to  the  platform  as  explained  in  Section  2.5. 

4.6.8  Force  Analysis  for  the  High  Frequency  Model 

The  final  model  that  can  be  used  is  the  one  that  describes  the  connector's  high 
frequency  mode  of  operation  where  the  coupling  stage  is  inactivated  by  setting  the  coupling 

damping  coefficient  to  a  very  high  value  as  discussed  in  Section  2.5  ( C  c  =»  °° ).  By  using 

a  high  value  for  the  coupling  stage  damping  constant,  this  stage  is  made  to  behave  as  a  rigid 
element.  The  force  will  be  completely  transmitted  through  the  stage  without  being  deflected 
(H  =  L).  In  this  case  the  resultant  forces  acting  upon  masses  M  e ,  M  d  and  M  b  remain  the 
same.  The  connector  force  vector,  which  is  given  by  equation  (38),  can  now  be  written  as 


(39) 


(41) 


Fl  =[Cd(D-L)  +  KL6L]s3 


(42) 


CHAPTER  5 

PARALLEL  MANIPULATOR  DYNAMIC  MODELING 


As  mentioned  before,  the  dynamic  model  of  the  spatial  parallel  manipulator  is  needed  in 
order  to  perform  an  inverse  dynamic  analysis.  This  analysis  will  determine  the  force, 
power  and  speed  of  response  of  the  system  actuators  based  on  the  desired  task  (based  on 
the  motion  planning).  This  will  help  the  designer  to  properly  select  the  actuators,  the 
dimensions  of  the  manipulator,  and  to  determine  the  values  for  system  parameters  such  as 
the  mass  of  the  platform  and  the  connector  stiffness. 

5.1  Selection  of  a  Dynamic  Formulation  Method 
The  selection  of  the  method  for  generating  the  system  equations  of  motion  is  critical  in 
the  development  of  a  dynamic  model.  Although  the  final  set  of  equations  of  motion  must 
be  the  same  regardless  of  the  method  chosen,  the  difficulty  of  setting  up  the  equations  of 
motion  depends  on  the  method  used.  It  is  clearly  desirable  to  choose  a  method  which  will 
genmte  the  equations  of  motion  in  the  simplest  manner  in  order  to  reduce  the  amount  of 
work  and  to  avoid  mistakes  and. 

5.1.1  Newton-Euler 

The  Newton-Euler  method  has  been  used  for  the  dynamic  analysis  of  the  platform  [5.1, 
5.2].  One  limitation  of  the  Newton-Euler  is  that  it  becomes  more  cumbersome  as  more 
rigid  bodies  are  included  in  system  model.  Another  limitation  is  the  workless  constraints 
are  included  and  have  to  be  eliminated  further  on  through  some  mathematical  operations 
which  can  involve  a  considerable  amount  of  work . 
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5.1.2  Lagrangian  Dynamics 

The  basic  concept  behind  this  method  is  that  the  change  of  energy  of  a  system  is  equal 
to  the  nonconservative  forces  applied  to  the  system  [26].  Nonconservative  forces  are 
basically  external  forces  and  frictional  forces  (such  as  viscous  damping).  These  forces 
increase  or  decrease  the  energy  level  of  the  system.  This  method  has  been  applied  to  a 
platform  system  to  develop  numerical  simulations  but  not  for  deriving  the  explicit  equations 
of  motion  [9,  10]. 

The  energy  of  the  system  to  be  analyzed  is  described  by  the  Lagrangian 


where  KE  is  the  kinetic  energy  of  the  system  and  PE  is  the  potential  energy .  The 
equations  of  motion  are  obtained  by  applying  the  following  equation  for  each  independent 
displacement  variable  of  the  system 


generalized  nonconservative  force  along  the  generalized  displacement  q  j.  Since  the 

potential  energy  is  only  a  function  of  the  displacement  variables,  the  above  equation  can 
also  be  written  as 


The  platform  system  has  six  independent  displacement  variables  to  describe  the 
location  of  the  platform  and  three  for  each  connector.  The  system  independent 
displacement  variables  are  the  location  of  the  platform  (position  and  orientation)  and  the 
displacements  E,  D  and  H  as  discussed  in  Sections  2.4, 2.5  and  3.3. 


L  =  KE-PE 


whCTe  q  j  is  the  genaalized  or  independent  displacement  variable  j,  and  Fj  is  the 


j  ldKE\  a(KE-PE) 


The  kinetic  energy  for  the  platform  system  is  given  by 
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T  .[Ie]-H[ld]-H[Ib] 
4^12   2  


lf^(Ye-Ye)-^{Yd-Yd)  +  ^(Yb-Yb) 


where  Mp,Me,Md,Mb,  [Ip],  [le],  [Id]  and  [lb]  are  the  masses  and  the  inertia  tensors 
of  the  platform  and  the  connector  rigid  bodies  respectively  (  see  Section  2.5 ).  The 
potential  energy  of  the  platform  system  is  given  by  ( see  Section  2.5 ) 


PE  = 


(MeE  +  MdD.Mbbl  )gs3,  +  J^c6ilK^ilKi6f 


+  MpC-gk 


The  partial  daivatives  required  to  determine  the  equations  of  motion  using  the  Lagrange 
formulation  can  prove  to  be  cumbersome  to  obtain  for  a  parallel  manipulator.  As  an 
example  consider  the  fourth  term  of  the  kinetic  energy  expression 


l[^(Ye-Ye)l^  =J:[M^[e2.e2(0)i^-03||) 


The  angular  velocities  co  i  and  co  2  are  functions  of  the  velocity  of  the  centerpoint  and 
angular  velocity  of  the  platform  as  derived  in  Section  3.4 


[Yc  +  (^o^Rpc)]-S2  .  ^,      [Yc  +  (m^Rpc)]-S23 

(01  =   ,  (02  =  


The  partial  derivative  of  this  term  of  the  kinetic  energy  can  then  be  written  as 


aqj\  i 


I  ^(Ye-YeD 


Me 


5(0  1  5(02 


E  +  E^    (0  1  +  (0  2 

aqj         \      aqj  aqj 
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where  the  partial  derivative  of  the  angular  velocities  co  i  and  co  2  are  given  by 


5(0 1 


5(02 


1 
L 


i 
L 


dqj  \aqj 


gVc  ^  pto 


aqj  \aqj 


•S2 


•S23 


Once  the  partial  derivatives  of  the  kinetic  energy  have  been  derived,  the  time  derivative  of 
the  resulting  expression  must  be  determined.  This  is  a  very  tedious  and  time  consuming 
pr(Kess  since  the  vectors  R  pc ,  S  2  and  s  2  are  time  dependent  functions  of  the  l(Kation  of 
the  platform.  Similar  complications  arise  when  obtaining  the  partial  derivatives  of  the 
kinetic  ena-gy  and  the  potential  energy  expressions  with  respect  to  the  displacement 
variables  since  there  are  many  terms  which  are  not  simple  functions  of  the  independent 
displacement  variables. 

The  Lagrangian  method  has  been  successfully  applied  to  serial  kinematic  chains  and  the 
explicit  equations  of  motion  have  been  obtained  for  some  serial  manipulators  [13, 14].  The 
main  reason  is  that  the  velocities  and  positions  of  all  the  rigid  bodies  of  the  system,  which 
are  required  for  the  kinetic  and  potential  energy  expressions,  can  be  written  as  simple 
functions  of  the  independent  displacement  variables  and  their  first  time  derivatives.  In  the 
case  of  the  platform  the  velocities  and  positions  of  the  rigid  bodies  are  not  simple  functions 
of  the  location  and  velocity  of  the  platform  as  shown  in  Sections  3.3  and  3.4.  This 
complicates  the  process  of  obtaining  the  partial  derivatives  required  for  the  equations  of 
motion. 

5.1.3  Kane's  Method 

The  method  used  in  this  thesis  for  deriving  the  dynamic  model  is  what  is  known  as 
Kane's  Method  for  Dynamic  Analysis  [27].  A  brief  explanation  of  how  to  use  this  meth(xi 
is  given  in  the  appendix  of  this  thesis.  The  equations  of  motion  for  the  dynamic  model  for 
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a  system  with  "w"  elements  (bodies  &  particles)  and  "n"  degrees  of  freedom  can  be 
obtained  by  using  the  following  equation  ,  ^ 


I  (^.{Fj  (^.{Ij-T.})  =  0;   k=l,2,...,n  (1) 

j=l  K  j^l  K 

where  F* j  and  T* j  are  the  Inertial  Force  and  Torque  respectively,  and  can  be  calculated  by 

Fj  =  mjAj    &    Tj  =  a  j*      + (Ojx 

This  equation  must  be  setup  for  each  of  the  degrees  of  freedom  of  the  system.  In  order  to 
obtain  the  dynamic  model,  expressions  for  the  following  terms  for  each  body  must  be 
determined 

,  the  velocity  partial  derivative  of  body  "j"  respect  to  the  kth  genaalized  speed 

ou  1^ 

^=j^ ,  the  angular  velocity  partial  derivative  of  body  "j"respect  to  the  kth  generalized  speed 
duk 

F  j ,  the  resultant  force  vector  acting  on  body  "j"  at  a  given  point  "c" 

T  j,  the  resultant  torque  vector  acting  on  body  "j",  about  the  point  "c" 

A  j ,  the  acceleration  vector  of  body  "j"  at  a  given  point  "c" 

m  j,  the  mass  of  body  j 

w  j ,  the  angular  velocity  vector  of  body  "j" 

a  j ,  the  angular  acceleration  vector  of  body  "j" 

Ij" ,  the  inatia  dyadic  of  body  "j",  about  the  point  "c" 


5.2  Mobility  Analysis 

The  first  step  in  setting  up  the  equations  of  motion  is  to  determine  the  degrees  of 
freedom  of  the  spatial  parallel  manipulator  or  platform.  The  platform  ( see  Figure  5. 1 ) 
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itself  has  6  degrees  of  freedom  since  it  is  a  rigid  body  in  space  free  to  move  when  all  the  six 
actuators  are  operational.  Each  connector  adds  on  three  more  degrees  offreedom  as 
outlined  in  Section  2.5  and  shown  in  Figure  5.2.  Since  there  are  six  connectors,  the 
system  has  a  total  of  24  degrees  of  freedom  . 

The  next  step  is  to  select  the  generahzed  coordinates  required  to  completely  describe  the 
system  configuration.  Six  variables  are  required  in  order  to  locate  the  platform  in  space. 
The  vector  C  will  be  used  to  describe  the  location  of  the  centerpoint  of  the  platform,  which 
accounts  for  three  of  the  degrees  of  freedom.  The  rotation  matrix  [R]  will  be  used  to 
describe  the  orientation  of  the  platform  in  space,  which  accounts  for  the  other  three  degrees 
of  freedom  for  the  platform.  A  detailed  description  of  C  and  [R]  is  given  in  Sections  3.1, 
3.3  and  3.6. 


Figure  5.1  -  Spatial  Platform 
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Each  connector  requires  three  generalized  coordinates  in  order  to  describe  its 
configuration  (see  Figure  5.2).  The  first  one  is  the  actuator  displacement,  E  The  second 
is  the  displacement  at  the  point  joining  the  connector  to  the  coupling  stage,  H.  The  third  is 
the  displacement  between  the  decoupling  damper  and  the  decouphng  spring,  D ,  as  shown 
in  figure  5.2.  In  summary,  the  generalized  coordinates  used  to  describe  the  complete 
system  are  (the  letter  "q"  will  used  to  designate  the  generalized  coordinates) 


Figure  5.2  -  Connector  Model  with  Generalized  Coordinates 


(qi)i  =  (E),;  (q2)i=  (H)n  {q3)i  =  (D)i 
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where  the  letter  "i"  indicates  the  number  of  the  connector,  i  =  1  to  6.  The  platform  will  be 
described  using  the  following  Generalized  Coordinates 

C  =  [Xc,  Yc,Zc]  =»qi9  =  Xc,  q20  =  Yc,  q21=Zc 
[R]  =  f(ex,ey,ez)  =>q22  =  0x,q23  =  ey,q24  =  6z 

5.3  Generalized  Speeds.  Velocity  and  Acceleration  Analysis 
The  next  step  is  the  selection  of  the  Generalized  Speeds.  These  are  variables  used  to 
describe  the  velocity  of  each  body  in  the  system  and  are  a  function  of  the  Generalized 
Coordinates  and  their  first  time  derivatives.  Although  tha-e  are  more  than  one  possible  set 
of  Generalized  Speeds,  the  number  of  elements  in  each  set  must  be  equal  to  the  number  of 
Generalized  Coordinates. 

5.3.1  Generalized  Speeds 

The  letter  "u"  is  used  to  designate  the  Generalized  Speeds,  which  are  functions  of  the 
Generalized  Coordinates  and  their  first  time  derivatives.  A  simple  choice  is  to  use  the  first 
time  derivative  of  each  Generalized  Coordinate,  q  j,  as  the  Generalized  Speed  u  j.  For  each 
connector  they  will  be  the  first  time  derivatives  of  the  Generalized  Coordinates  E ,  H  &  D 

{ui),  =  |(E).;  (u2).  =  ^(H)i;  (u3)i  =  ^(D)i 

The  Generalized  Speeds  of  the  vector  C  are  the  first  time  derivatives  of  the  centerpoint 
coordinates 

(Cx)  =  Vcx  =  Ul9,    ^(Cy)  =  Vcy  =  U20,  ^(Cz)=Vcz=U21 
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The  elements  of  the  platform's  angular  velocity  vector  w=[(Ox,Wy,Wz]^  about  the 

axes  of  the  Base  Coordinate  System  are  used  as  the  Generalized  Speeds  of  the  rotation 
matrix  [R]  and  thus 

Wx  =  U22,     Wy  =  U23,  Wx=U24 

5.3.2  Velocity  Analysis  •    , ,  - 

Each  of  the  bodies  on  the  connector  will  have  a  similar  expression  for  their  velocity 
vectors  and  the  same  expression  for  their  angular  velocity  vectors.  The  angular  velocity 
vector  for  the  rigid  bodies  of  the  connector  is  given  by  (  see  Section  3.4 ) 

[(Yc- S2)  +  C0  •(RpcXS2)]  ^     ^[(Yc-S23)  +  tO  ♦(RpcXS23)]  ^ 

W  12  =   J-  ~   s  1  +  J-   s  2 

The  velocity  vectors  of  the  base  mass,  the  decoupUng  stage  mass  and  the  actuator  mass, 
(see  Section  3.4 )  are  given  respectively  by 


Yb  =  ^[(Yc-S2l)+m-(Rpc''S2)]  §2  + 


g[(Yc'S23)+W-(RpcXS23)]s23  (3) 


Yd=DS3+  g[(Yc-S2)+40  -(RpcXSz)]  §2  + 


P  [(Yc-S23)+iO  •(RpcXS23)]  §23  (4) 


Ye=ES3+  E[(Vc-S2)  +  W  •(RpcXS2)]  S2  + 


f  [(Yc-S  23)+m  -(EpcXSis)]  S  23 


(5) 


Using  the  definitions  for  §  i ,  s  2  and  s  23  given  in  Section  3.3,  the  angular  velocity  vector 
12  can  also  be  written  in  terms  of  the  Generalized  Speeds  defined  above 


u 


^12 


19 

l" 


I     0  \ 


~^3z'^23x 


/  -< 


^20 


'3z 


\ 


'^3z'  ^23y 
\  ^23y  ^3y  / 


'21 


~  ^3z'  ^23z  ' 


U 


22 


R    •  s,  +  R_  •  s, 

pcy    3y        pcz  3z 
C^pcz  ^23y  ~  ^pcy'  ^23^  "  ^3z 
C^pcy'  ^23z  ~  ^pcz'  ^23y^  "  ^3y 
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<?pcx-^3y) 


C^pcx'  ^23z     ^pcz"  ^23x)  '  ^3z 


^23x      ^pcx'  h3z)  '  hy 


U. 


24 

T' 


~^pcx"  ^3z 
^pcy"  ^23x  ~  ^pcx"  h3y)  '  hz 
C^pcx'  ^23y  ~  ^pcy'  ^23jD  "  ^3y 


(6) 


The  velocity  vectors  Y  b ,  Y  d  and  Y  e  can  also  be  written  in  terms  of  the  generalized 
speeds  defined  above 


'  fex)'  ■ 

bl 

bl 

^23y'  ^23x 

+  "2o-r 

^23z"^23x 

^23y'  ^23x 

(^3;)'+  023y)' 
^23y'  ^23z  ~  ^3z'  ^3y 
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E 

3y 

^23y"  ^23x 
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^23z'  ^23x 

D 

"20- l' 
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D 
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^23z'  ^23x 
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^22  L* 


C^pcy'  ^23z      ^pcz'  h3y)  '  ^23x 
023Z-  S23y  "  '  V  "  [  (^3^  '  +  023y)  '  ]' 

'23y) 
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D 
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23x  ^23y'^pcz 
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"24- 1- 


O^pcx"  ^23y     ^pcy'  ^23x)  '  '23x 


Rpcy''23x)-s 

[  ^3^  '  +  fey)  '  ]•  Vx  -  '23x-  S23y-  ^ 


pcy 

23y  ''23Z  ~  ^3y'  ^3^  *  ^pcx  ~  ^23x"  ^23z*  ^pcy 


(9) 


Using  the  Generalized  Speeds  defined  previously,  the  angular  velocity  and  the  velocity 
vectors  for  the  platform  are  given  by 


(10) 


/u  \ 

f"22\ 

V  = 

— c 

"20 

W  = 

"23 

^4/ 

5.3.3  Acceleration  Analysis 

As  derived  in  Section  3.5,  the  angular  acceleration  vector  a  12  for  all  the  rigid  bodies  of 
the  connector  is  given  by 

a  12  =  a  IS  1  +  a2S2+ wi(02[  S2XS  1  ]  (11) 
The  acceleration  vector  for  the  mass  M  b  can  be  written  as 

Ab  =  bl[aiS2  +  a2S23  +  wi(02(si  •§31)82]  (12) 
The  acceleration  vector  for  the  decoupling  stage  mass  M  j  can  be  written  as 

Ad=D  S3  +  2D(  (01S2  + 102 s 23 )  +  D( a  1  82  +  02823)  + 
d[  2(Oit02(si  •831)82  +  03^(81  •S3)si-((o5  +  w|)s3]  (13) 
The  acceleration  vector  for  the  actuator  mass  M  e  can  be  written  as 

Ae=ES3+2E(WiS2  +  W2S23)  +  E(aiS2  +  a2S23)  + 


e[  2(0  1  C02(s  1  •S3i)s2  + w](s  1  •§3)5  i-(co?  +  coi)s3]  (14) 


The  angular  acceleration  and  acceleration  vectors  for  the  platform  are  given  by 
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a  = 
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(15) 


a 


5.4  Velocity  and  Angular  Velocity  Partial  Derivatives 


r '  One  of  the  distinctive  features  of  Kane's  Method  is  the  use  of  the  velocity  and  angular 
velocity  partial  derivatives  of  each  body  with  respect  to  the  generalized  speeds.  These 
partial  derivatives  define  the  directions  of  the  instantaneous  translational  and  rotational 
displacement  of  each  body.  A  more  complete  explanation  is  given  in  the  appendix. 

As  shown  in  Section  3.4,  the  connector  angular  velocity  vector  co  12  can  be  written  as 


This  angular  velocity  vector  is  a  function  of  the  Generalized  Speeds  u  19,  u  20,  u  21,  u  22, 
u  23  &  u  24  as  shown  in  equation  (6).  The  angular  velocity  partial  derivatives  for  these 
bodies  with  respect  to  the  generalized  speeds  u  1  through  u  3  are  (k  =  1  to  3) 


The  angular  velocity  partial  derivatives  the  generalized  speeds  u  19  through  are  u  24 


0212  =  [(Yc-S2l)s  i+(Yc-S23)  §2]  + 

[(w  •(RpcXS2))s  1  +(C0  •(RpcXS23))  S2] 


=  0 
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(17) 


^  =  [s2ySi-S23yS2]-f 
6U20 


(18) 


^  =  [s2zSl-S23zS2]| 
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^  =  [Si(RpcXS2)x  +  S2(RpcXS23)x]| 
6U22 
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^  =  [Si(RpcXS2)y  +  S2(RpcXS23)y]| 
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5coi2 
6u24 


=  [S  l(Spc^S2)z  +  S  2(RpcXS23)z]  j" 


(22) 


where  ( R  pc  x  s  2 )  x,  y,  z  are  the  respective  x,  y  and  z  components  of  the  vector  product  of 
the  vectors  R  pc  and  s  2  ;  and  ( R  pc  x  s  23 )  x,  y,  z  are  the  respective  x,  y  and  z  components 
of  the  vector  product  of  the  vectors  R  pc  and  s  23  •  These  velocity  partial  derivatives  can  be 
also  be  written  in  their  expanded  form 
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-•  I  ■^23x'^3z 


1  I-. 
I' 


^23x"  ^3y 


(17.a) 


'(^12) 


/  -. 


1 

l' 


'3z 


"  ^23y'  ^3z 
\  ^23/  I 


(18.a) 
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l" 


»3y 
\  h3z  hy  I 


(19.a) 


'(^12) 
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Vy"^3y  ^pcz'hz 
C^pcz  hSy  ~  ^pcy'  ^23^  '  ^ 
(^pcy*  ^23z  ~  ^pcz  *23y) 


'3z 

^3yJ 


(20.a) 


'(^12) 


1 
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pcx  ^23z  ~  ^pcz"  hix)  '  hz 
C^pcz"  ^23x  ~  ^pcx'  h3z)  '  hy 


(21.a) 


1 

L 


~^pcx"  ^3z 
C^pcy'  ^23x  ~  ^pcx'  hSy)  '  hz 
C^pcx'  ^23y  ~  ^pcy*  ^23x)  "  ^3y 


(22.a) 


The  velcxjity  partial  derivatives  of  the  base  mass  with  respect  to  the  Generalized  Speeds  u  1 
through  u  3  of  each  connector  (k=lto3)are 


6u. 


=  0 


(23) 


Using  the  expression  for  Vb  derived  in  Section  3.4  and  the  definitions  of  the  Generalized 
Speeds,  the  velocity  partial  derivatives  of  V  b  with  respect  to  the  Generalized  Speeds 
u  19  through  u  24  can  be  written  as 


^  =  [s2xS2-^S23xS23]f 

Bu  19  ^ 


(24) 


 [  S  2y  S  2  +  S  23y  S  23  J  7- 

6u20 


^  =  [s2zS2-^S23zS23]f 

6u2i  ^ 


^  =  [§2(Spc''S2)x  +  S23(Rpc'^S23)x] 
6U22 


M 
L 


=  [S  2(SpcXS2)y  +  S23(Bpc^S23)y] 

6U23 


bl 
L 


^  =  [S2(SpcXS2)z  +  S23(Spc''S23l)z]f 


6U24 


These  velocity  partial  derivatives  can  also  be  written  in  their  expanded  form 


^C^b)  _  bl 
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6u 
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^23y'  ^23x 


^23z'  ^23x 


5(^0  _bl 


^23y'  ^23x 
h3y  hZz  ~  hz  hy 
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r' 


^23z'  ^23x 
^23y*  ^23z  ~  ^3z'  ^3y 

03y)'+  O23O' 
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^2 


bl 

l" 


(^pcy'  ^23z     ^pcz"  ^23^  '  ^23x 
023Z-  ^23y  "  ^3y-  ^3^  "         "  [  C^^  '  +  fey)  '  ]'  ^pcz 
[  03y)  '  +  (^23^  '  ]•  Vy      C3y-  ^3z  "  ^73z  h3y)  "  ^pcz 


(27.a) 
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l" 


^23x      ^pcx"  ^23^  ■  ^23x 


[-023;)'-C3y)'}V^23x^23z-R, 


^pcx      ^23x'  ^23y'  ^pcz 


(28.a) 


^4 


bl 

l" 


(?pcx- 


23y        pcy  ■'23x;  ''23x 


[O30'+fey)'}Vx-^23x-«23y-R| 


023y'  ^23z     ^3y'  ^3^  '  ^] 


pcy 


PCX      ^23x'  ^23z'  ^pcy 


(29.a) 


The  velocity  partial  derivatives  of  the  velocity  vector  V  a  with  respect  to  the  Generalized 
Speeds  u  i  and  u  2  of  each  connector  are  given  by 


(30) 


6u, 


6u. 


The  velocity  partial  derivative  of  the  velocity  vector  V  a  with  respect  to  the  gaiCTalized 
speed  u  3  of  each  connector  is  given  by 


6u, 


/s  \ 


*3y 
\  3z/ 


(31) 
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The  velocity  partial  derivative  of  the  velocity  vector  V  g  with  respect  to  the  Generalized 
Speeds  u  i  of  each  connector  is  given  by 


1^ 
6u. 


»3y 
\^3z, 


(32) 


The  velocity  partial  derivatives  of  the  velocity  vector  V  e  with  respect  to  the  Generalized 
Speeds  u  i  and  u  2  of  each  connector  are  given  by 


6u„ 


=  0 


6u. 


=  0 


(33) 


The  velocity  partial  derivatives  of  tiie  velocity  vectors  V  a  and  V  e  with  respect  to  the 

Generalized  Speeds  u  19  through  u  24  are  the  similar  to  those  for  the  velocity  vector  V  b,  the 

difference  is  that  instead  of  bl  the  displacements  D  and  E  are  used 

The  velocity  partial  derivatives  of  the  centerpoint  velocity  vector  V  c  with  respect  to  the 

Generalized  Speeds  u  19  through  u  21  are 


=  10 
10/ 
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■F 

\0 


(0\ 
=  10 


(34) 


The  angular  velocity  partial  daivatives  of  the  angular  velocity  vector  w  with  respect  to  the 
Generalized  Speeds  u  22  through  u  24  are 


6(02) 


6(co) 


6u 
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The  velocity  and  angular  partial  derivatives  of  the  platform  with  respect  to  the  remaining 
Generalized  Speeds  are  zero. 

5.5  Setting  up  the  Dynamic  Model 
As  stated  in  equation  1,  the  dynamic  model  for  a  system  with  "w"  bodies  and  "n" 
degrees  of  freedom  can  be  generated  by  using  the  following  equation 

i  (f^-{Fj  (^•{Tj-T-})  =  0;  k=l,2,...,n 

j  =  l  K  j^j 

this  equation  can  be  simplified  somewhat  by  using  the  following  expressions 

F'j=  Fj  -  mjAj  (36.a) 

Tj=Tj  -[(aj.lj")  +  ((0jxlj".i0j)]  (36.b) 

where  expressions  for  the  resultant  forces  F  j,  torques  T  j,  angular  velocities  w  j, 

accelerations  A  j  and  angular  accelerations  a  j  for  each  of  the  bodies  of  the  spatial  parallel 
manipulator  system  are  given  in  Chapters  3  and  4.  Equation  (1)  can  now  be  written  as 

i  (if -Ep-f/l^      ^=1.2  ■> 

The  force  term  is  known  as  the  effective  force,  F'j ;  the  torque  term  is  known  as  the 
effective  torque,  T'j. 

5.5.1  Formulating  the  Dynamic  Model 

The  spatial  parallel  manipulator  system  has  19  bodies  (the  platform  and  three  bodies  for 
each  connector)  and  24  degrees  of  freedom  (w=19&n  =  24).  By  using  the  above 
expression,  the  model  of  the  spatial  platform  can  be  generated.  This  model  has  24 
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equations.  The  general  form  of  the  kth  equation  of  motion  for  the  spatial  platform  is 


where  the  letter  "i"  designates  the  ith  connector  (i  =  1  to  6).  The  first  six  terms  of  this 
equation  describe  the  motion  of  the  mass  M  e ,  the  second  six  terms  describe  the  motion  of 
the  mass  M  d ,  the  third  six  terms  describe  the  motion  of  the  mass  M  b ,  and  the  last  tem 

describes  the  motion  of  the  platform  itself. 

Although  the  use  of  equation  (38)  for  setting  up  the  model  may  seem  to  be  very  time 
consuming  and  tedious,  it  becomes  rather  simple  since  many  of  the  velocity  and  angular 
velocity  partial  derivatives  are  zero.  For  the  first  degrees  of  freedom  of  each  connector  (6 
dof  in  total)  all  the  velocity  and  angular  velocity  partial  derivatives  are  zero  except  the 
velocity  partial  derivative  of  the  velocity  vector  Vg  as  indicated  in  equation  (32).  The 
equation  of  motion  for  the  first  degree  of  freedom  of  each  connector,  which  generates  the 
first  six  equations  of  motion,  can  be  written  as 

((j^eli  .(p-  )  \^0;     fori=lto6  (39) 
\  OUk  / 

The  equations  of  motion  for  the  second  degree  of  freedom  of  each  connector  is  zero 
since  the  effective  forces  for  this  degree  of  freedom  are  zero  (there  is  no  mass  at  the  point 
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of  displacement  H ).  This  is  a  problem  since  the  dynamic  model  requires  24  equations. 
This  problem  will  solved  by  defining  some  auxiliary  equations  later. 

For  the  third  degree  of  freedom  of  each  connector,  all  the  velocity  and  angular  velocity 
partial  daivatives  are  zcto  except  the  velocity  partial  derivatives  of  the  velocity  vector  V  d  as 
indicated  in  equation  (31).  The  equations  of  motion  for  this  degrees  of  freedom,  which 
generates  the  next  six  equations  of  motion,  is  given  by 

.(F'Ji|  =  0;     fori=lto6  (40) 

The  equations  of  motion  for  the  last  degrees  of  freedom  are  more  complicated  since 
most  of  the  velocity  and  angular  velocity  partial  derivatives  are  not  zero  as  was  the  case  in 
the  connector  degrees  of  freedom.  The  general  equation  of  motion  for  the  last  six  degrees 
of  freedom,  which  describes  the  translation  and  rotation  of  the  platform  about  the  X,  Y,  Z 
axes  is  given  by  (for  k  =  19  to  24) 


Since  the  velocity  partial  derivatives  of  w  for  the  Generalized  Speeds  u  19  ,u  20  and  u  21  are 

zero,  the  general  equation  of  motion  for  the  translation  of  the  platform  can  be  written  as 
(fork=  19  to  21) 
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Since  the  velocity  partial  derivatives  of  V  c  for  the  Generalized  Speeds  u  22    23  and  u  24 
are  zero,  the  general  equation  of  motion  for  the  translation  of  the  platform  can  be  written  as 
(fork  =  22  to  24) 


5.5.2  Effective  Forces  ■  . 

The  difference  between  the  resultant  force  acting  on  a  given  body,  F j,  and  its  inertial 
force,  m  j  A  j,  is  known  as  the  effective  force,  F'j.  The  resultant  forces  acting  on  each 
bodies  of  the  spatial  manipulator  were  derived  in  Chapter  4,  the  accelerations  for  each  body 
were  derived  in  Chapter  3.  The  effective  forces  for  the  platform  and  the  bodies  on  each 
connector  are  given  by 

F'e=Fe-MeAe  (43) 
F'd=Fd-MdAd  (44) 
F'b=Fb-MbAb  (45) 
F'c=Fc-MpAc  (46) 

These  equations  can  expanded  using  the  expressions  for  the  resultant  forces  and 
accelerations  derived  in  Sections  4.6  and  3.5  respectively 

F'e  =  [pa-CtE  -Kl6l]  S3-[Meg]k  - 


MeE  S3  -  2MeE(  (OiS2  +  W2S23)-MeE(aiS2  +  a2S23)- 
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MeE(2(0iW2(si  '83)82 +  w](s  1  •  8  3l)si-(wi +  0)21)83)  (47) 


F'd=  [-Cd(b  -L)  -Kd6d]  S3  -[  Mdg]k 


MdD  S3-2MdD(  W1S2  + W2S23)-MdD(ai  82  +  a2S23)- 


MdD(2coi  i02{s  1  •  83)82 +  wi(si  •S3l)si-(wi  + co|l)s3)  (48) 


F'b  =  [CtEi  -Fr]  S3  -[  Mbg]k-Mbbl(aiS2  +  a2S23)- 

Mbbl(2coi  W2(s  1  •83)82  +  ^1(81  •S3l)si-(w5  +  (o|l)s3)  (49) 


F'c  = 


Fg  +  Fext+  £  F1S3 
i  =  l 


-  Mp  Ac 


(50) 


5.5.3  Effective  Torques 

The  difference  between  the  resultant  torque  acting  on  a  given  body,  T j,  and  its  inertial 
torque,  m  j  A  j,  is  known  as  the  effective  torque,  T'j.  The  resultant  torques  acting  on  each 
body  of  the  spatial  manipulator  were  derived  in  Sections  4.4  and  4.5,  the  angular  velocities 
and  accelerations  for  each  body  were  derived  in  Section  3.4  and  3.5.  The  effective  torques 
for  the  platform  and  the  bodies  on  each  connector  are  given  by 


I'e  =  le  -  [  fit  12  •  le"  +  W  12  X  le"  •  (0  12  ] 

I'd  =  1  d  -  [  a  12  •  Id"  +  CO  12  X  Id"  •  CO  12  ] 


I'b  =  lb  -  [  a  12  •  lb"  +  (0 12  X  lb"  •  w  12 1 


(51) 
(52) 
(53) 
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6 

Text  +  £  Fi  So3 
i  =  l 


[  a •  Ip"  +  (OX Ip"  •  ij)]  (54) 


where  le",  Id",  lb"  and  Ip"  are  the  body  inertia  dyadics  (  see  the  appendix ). 

5.5.4  Inertia  Dyadics 

The  inertial  properties  of  a  rigid  body  in  space  are  usually  described  using  the  inertia 
tensor.  A  more  compact  and  useful  method  is  the  inertia  dyadic  [27].  A  dyadic  is  a 
juxtaposition  of  vectors,  a  inertia  dyadic  is  the  use  of  a  dyadic  to  describe  the  inertia  of  a 
rigid  body.  The  inertia  dyadic  for  a  body  can  be  defined  in  term  of  its  principal  axes  and 
principal  inertias,  as  explained  in  detail  in  the  appendix.  The  principal  axes  s  23,  s  2  and  s  3 
for  each  of  the  rigid  bodies  on  the  connector  are  shown  in  figure  5.3.  The  inertia  dyadic 
for  the  base  inertia,  decoupUng  stage  inertia  and  the  actuator  inertia  are  given  by 

-  Ib"  =  Ibxx[S23][S23]  +  Ibyy[S2][S2]  +  Ibzz[S3][S3]  (55) 

Id"=Id„[S23][S23]+Wyy[S2][S2]  +  Wzz[S3][S3]  (56) 

Ie"  =  Iexx[s23][s23]  +  Ieyy[s2][s2]  +  Ie2z[S3][s3]  (57) 

where  le  XX,  Wxx,  Ibxx^lsyy,  Idyy,  Ibyy,Iezz,  Id  zz  and  lb  zz  are  the  principal 
moments  of  inertia  of  the  connector  rigid  bodies.  The  inertia  dyadic  for  the  platform  is 
given  by 

Ip"  =  Ip  XX  [X  m 

][Xm]  +  IPyy[Ym][Ym]  +  Ip  zz[Z  m  ][Zm]  (58) 
where  Ip  xx ,  Ip  yy  and  Ip  zz  are  the  principal  moments  of  inatia  of  the  platform. 


Figure  5.3  -  Principal  Axes 


5.6  Deriving  the  Equations  of  Motion 

The  dynamic  model  of  the  platform  system  is  described  by  24  equations  of  motions. 
These  equations  are  obtained  by  using  equation  (1)  for  each  of  the  degrees  of  freedom  of 
the  system. 

5.6. 1  Equation  of  Motion  for  the  mass  M 

The  equation  of  motion  for  the  mass  M  e  can  be  obtained  by  using  equations  (32),  (39) 
and  (47) 

f-^-(F;)i)  =  ([Fa-C,E-K,6,ls3-[Meg]k).S3 

( -MeE  S3 -2MeE(  WiS2  +  W2S23)-MeE(aiS2+a2S23l)l)  •§3  + 
(-MeE(2tOi  C02(s  1  •  S3i)s2  +  Wi(s  1  •§3)5  1  -(       +  w|)s3))  •  §3  =  0 
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Figure  5.4  -  Hooke  Joint  at  the  base  of  the  connector 

As  mentioned  in  Sections  3.3  and  3.4  the  vector  s  i ,  which  has  been  selected  to  be  parallel 
to  the  fixed  X  axis,  describes  the  first  axis  of  the  Hooke  joint  of  the  HPS  serial 
manipulator  (  see  Figure  5.4 ).  The  vector  s  2  describes  the  second  axis  of  the  Hooke  joint 
and  is  the  resultant  of  the  vector  product  of  s  1  and  §  3.  The  vector  s  3  is  parallel  to  the 
connector  itself  and  s  23  is  the  resultant  of  the  vector  product  of  s  2  and  s  3.  The  evaluation 
of  all  the  equations  of  motion  will  required  the  following  scalar  products 

§1*52;  §1-823;  81-83;   82*83;  §23  '83;  S23*S2 

Since  the  vectors  s  1  and  s  2  are  perpendicular,  and  §2,83  ,and  s  23  are  mutually 
perpendicular  the  following  scalar  products  zero 

82*83  =  0;    §23 '83  =  0;    §23  *82  =  0;    §1-82  =  0  (59) 
Since  the  vector  §  1  is  parallel  to  the  X  axis,  the  remaining  scalar  products  are 

Si  *§23  =  S23x  ;     §1  -  §3  =  S3x  (60) 
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By  using  equations  (59)  and  (60),  the  equation  of  motion  for  M  e  can  be  simplified  to 

Fa=Me[E+gS3^+  E(0^(S3j2.E((0^  +  wi)]+C,E+KL5L  (61) 

The  first  term  on  the  right  hand  side  indicates  that  the  actuator  has  to  accelerate  the  mass 
M  e.  This  acceleration  is  the  sum  of  the  body's  own  acceleration,  the  gravitational 

acceleration  and  the  centrifugal  acceleration.  The  actuator  also  has  to  move  against  the 
friction  force  its  generates  and  has  to  deform  the  K  l  spring. 

5.6.2  Equation  of  Motion  for  the  mass  M  ,\ 

The  equation  of  motion  for  the  mass  M  d  can  be  obtained  using  equations  (31),  (40)  and 
(49) 

f-^^-(F'J.|  =  ([-Cd(D-L)  -Kd6d]s3-[Mdg]k).S3  + 

(  -  MdD  §3  -  2MdD(  toi  §2  +  i02S23)-MdD(ai  §2  +  02823))  *  S3  + 
(-MdD(2(Oi002(si  ♦S3)s2  +  Wi(si  •S3)Si-(tOi+C02)s3))*S3  =  0 

Using  the  equations  (59)  and  (60),  this  equation  can  be  simplified  to 

Md[D  +  gS3z  +  Dto|(s3j2.D(co?  +  (o|)  l  +  Cd(D-L)  +  Kd6d=0  (62) 

Although  the  decoupling  stage  does  not  have  an  actuator  to  move  its  mass,  the  energy  is 
supplied  by  external  sources  such  as  the  rotation  of  the  connector  which  produce  the 
centrifugal  terms  and  the  extension  of  the  decoupling  damper.  These  forces  move  the 
decoupling  stage  against  gravity ,  accelCTate  the  decoupling  stage  mass,  and  move  the 
decoupling  stage  mass  against  its  friction  and  stiffness  element . 
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5.6.3  Platform  Equations  of  Motion 

The  platform  equations  of  motion  can  be  divided  into  two  types:  those  that  produce  the 
translation  of  the  platform  and  those  that  produce  the  rotation  of  the  platform.  The  general 
forms  of  the  platform  equations  of  motion  are  given  by  equations  (41)  and  (42).  Equation 
(41)  must  be  evaluated  for  the  generalized  speed  u  19,  u  20  and  u  21;  and  equation  (42)  must 
be  evaluated  for  the  generalized  speed  u  22.  u  23  and  u  24- 

5.6.3.1  Translation  along  the  X.  Y  and  Z  axes 

The  general  equation  of  motion  for  the  translation  of  the  platform  along  the  X  Y  and  Z 
axes  is  given  by  (k  =19, 20  and  21) 


The  first  three  terms  of  the  above  equation  can  be  evaluated  using  equations  (24),  (25)  and 
(26)  for  the  velocity  partial  derivatives  with  respect  to  the  generalized  speeds  u  19 ,  u  20  and 

u  21.  These  velocity  partial  derivatives  have  the  following  general  forms 

=E[UkS,.QkS23] 


where  U 19  =  s  2x  ,  U  20  =  s  2y  ,  U  21  =  s  2z  and  Q  19  =  s  23x  ,  Q  20  =  s  23y  ,  Q  21  =  s  23z  • 
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Using  these  general  forms  for  the  velocity  partial  derivatives,  the  first  three  terms  of 
equation  (63)  can  be  expanded  to 


£  ([Fa-CtE-KL6L]s3-[Meg]kl)  .E[UkS2  +  QkS23]  + 


t  (-MeE  S3 -2MeE(  W1S2  +  CO2S23)  )  '  ~  [  U  k  §  2  +  Qk  S  23  ]  + 
i  =  l  ^ 


£  -MeE(ai  §2+  a2S23  +2  (0  1  W2(s  1  •  83)82!)       [UkS2  +  QkS23]  + 


y  (-MeE(  Wl(si  •S3l)Si-(co5  +  wii)s3))  •E[UkS2  +  QkS23]  + 
i  =  l  ^ 


y  ([-Cd(D-L)  -Kd6dls3-[Mdg]k)  •  P[  U k  s 2  +  QkS 23]  + 
i  =  l  ^ 


6 

£  (-MdDS3-2MdD((OiS2  +  l02S23)  )*P[UkS2  +  QkS23]  + 
i  =  l  ^ 


6 

£  -MdD(aiS2  +  a2S23  +  2coiW2(si  •  83)82)  •  P[UkS2 +  Qk §23]  + 
i  =  i  ^ 


£  (-MdD(        (Sj  -83)81 -((01 +  105)83))  •P[UkS2  +  QkS23]  + 

i  =  l  ^ 
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6 

£  ([  CtE-Frls3-[Mbg]k)-^[UkS2  +  QkS23]  + 
i  =  1 


6 

I 

i  =  l 


£  -Mbbl(  ai  §2  +  a2S23  +  2  coi  C02(s  i  •  s  3)5  2I)  *  ^[  U  k  S  2  +  Qk  S  23]  + 


6 

I 

i  =  l 


£  (-Mbbl(  (0^(S  1  •S3l)Si-((0^  +  C0|l)s3))  •^[UkS2  +  QkS23] 


As  given  by  equation  (59),  the  above  equation  can  be  simplified  considerably  by  the  feet 
that  many  of  the  scalar  products  required  for  its  evaluation  are  zero 

§2 '83=  §23  •  §3=  §23  '8  2=  Sl  '§2  =  0; 

The  equation  of  motion  can  then  be  written  as 


i  =  l 


MeE  +  MdD+  Mbbl] 


[UkS2z-*-  QkS23z] 


I 

i  =  l 


6 

I 

i  =  l 


6 

I 

i  =  1 


6 

I 

i  =  l 


2[MeEE  +  MdDD] 


Ukwi  +  QkW2] 


-'1 


L 

[MeE2+ 

MdD2+  Mbbl2] 

L 

[MeE2  + 

MdD2+  Mbbl^] 

L 

^1 


2UkWl  (02  S3x 


QkCOl  S3x  S23x 


(64) 
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The  fourth  term  of  equation  (63)  can  be  evaluated  by  using  equations  (17),  (18)  and 
(19)  for  the  angular  velocity  partial  derivatives  with  respect  to  the  generalized  speeds  u  19 , 
u  20  and  u  21-  These  angular  velocity  partial  derivatives  have  the  following  general  form 


^  =f[UkSi-QkS2] 

ouk  L 


where  U  19  =  s  2x  ,  U  20  =  s  2y  ,  U  21  =  s  2z  and  Q  19  =  s  23x  ,  Q  20  =  S  23y  ,  Q  21  =  S  23z 
Using  the  expression  for  the  effective  torques  given  in  equations  (51),  (52),  and  (53),  the 
fourth  term  of  equation  (61)  can  be  written  as 


6 

I 

i  =  l 


i  •  [  -  f  (  «  12 ).  •  (  II").  M  m  12)i  X  ( Il")i  •  ( CO  I2l)i  ]  ] 

^  duk 


i  =  1 


where  D"  is  the  sum  of  all  tiie  mass  dyadics  of  the  rigid  bodies  on  the  connector.  Using  ^ 
equations  (55),  (56)  and  (57)  and  the  generalized  form  of  the  angular  velocity  partial 
derivative,  the  above  equation  can  be  expanded  to  ,  ..  .. 

£  -n..((«l2)r(S23i)i)((S23l).'(^'-^Y^Q'-^^l)J- 


i  Il,J(UiLlJ_^Qil2|)  .((wi2).x(S23)i)l[(S23l)i-(mi2l)i] 
i  =  l        i\  L  li  J 


i  Ilyy((ai2)i-(S2)i)((S2)i-(^^^-^ 
i  =  l  ^ 


QkS 
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£  Ilyyfl^'^-V^'^-^l)  •((mi2hMS2l)i)l[(S2)i-(mi2) 
i  =  l        L\  1-  /i 


i  Ilzz((ai2)r(S3),)((S3).-(^'^^^^^^)J- 


6 
i  =  l 


Uk s 1  +  QkS2 )  . 


((Wi2)ix(s  3)i) 


[(S  3l)i  -(m  12l)i] 


The  principal  moments  of  inatia  of  the  rigid  bodies  about  the  X  and  Y  axes  are  equal.  By 
using  equation  (59),  which  states  that  many  of  the  scalar  products  required  for  evaluating 
the  above  equation  are  zero,  this  part  of  the  equation  of  motion  can  be  simplified  to 


-i  [  U  k  (  ^  ( II  zz  S  3.  ^  II XX  S  23X  ^  1)^  ^  ^  ^  ^  V  '  (flzz-Ilxxl)) 
i  =  1 


6  2 
(0  1  ^ 


I  Qk^nxx  -I  Qk^  S23yS3x(nxx-Ilz^)  (65) 
i  =  l  ^        L         Ji    .^-j  L         L  J, 


Using  equation  (50)  and  the  fact  that  the  platform  angular  velocity  partial  derivatives  for  the 
generalized  speeds  u  19,  u  20,  and  u  21  are  zero,  the  last  term  of  the  general  equation  of 

motion  can  be  written  as 


avc 
auk 


Fg+  Fext-  I  (FlS3l)i-MpAc 
i  =  l 


The  equation  of  motion  for  translation  along  the  X  axis  is  given  by  (k  =  19, 
Ui9  =  S2x  andQi9  =  S23x) 


£  (Fl  S3xl)i  =  MpAcx  +  Fext,x  + 
i  =  l 


=  1 


I 

i  =  l 


2[MeEE+MdDD] 


S23x  W2 


6 

I 

i  =  l 


823x0  2 


6 

I 

i  =  l 


[MeE2+MdD2+  Mbbl^]  2  2 
^— ^  ^-   S3x  S23x2 


6 

I 

i  =  l 


S23x  S3x^(Dxx  -nzzi) 


i  =  l 


I  S23x4^Il 


XX 


Analogously,  the  equation  of  motion  along  the  Y  axis  can  be  written  as  (k 
U  20  =  S  2y  and  Q  20  =  S  23y  ) 


£  (Fl  S3y|)i  =  MpAcy  +  Fext,  y  + 
i  =  l 


i  =  l 


MeE+MdD+  Mbbl] 


S2y  S2z+  S23y  S23z] 


I 

i  =  1 


2[MeEE  +  MdDD] 


[  S2y(0l  +  S23y  t02] 
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^   [[MeE2+MdD2+  Mbbl2]r  -  ^2  .  1 

y      L  e  D  i[2cOit02S3xS2y+tOi  S3xS23x  S23yJ 

=  1  ^ 


i  =  l 


i  =  l 


^^^^0)1032  S23XS3X    (11^. 11,0 


I  |s23yS3x-^(nxx-Ilzz) 


i  =  1 


(67) 


Analogously,  the  equation  of  motion  along  the  Z  axis  can  be  written  as 


£  (FLS3z)i  =  MpAcz  +  Mpg  +  Fext,  z  + 
i  =  l 


i  =  l  ^ 


I 

i  =  l 


2[MeEE  +  MdDD]  r 

— —   S     (O  1  + 


[  S2zWl  +  S23zW2]  + 


^       MeE2+MdD2+  Mbbl2  ,  ^  . 

y  ^— ^  ^[S2zai  +S23za2] 

i  =  l  ^ 


6 

I 

i  =  l 


MeE2-HMdD^+  Mbbl^Jj^^^..,  „     „  ^..2 


W2  S3x  S2z  +  Wi  S3x  S23x  ^23z- 
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i  f  S2z^(llzzS3x2-^nxxS23x2)l,  +  £      S23z^  Dxx 


=  1 


i  =  1 


i  =  l 


^^^^^^UC^^Sj^^  (iizz-nxx) 


i  =  l 


I  [s23zS3x^(nxx-nzz) 


(68) 


Using  the  fact  that  the  coefficients  U  k  and  Q  k  are  the  components  of  the  vectors  s  2 
and  s  23 ,  the  equations  of  motion  for  the  translation  of  the  platform  along  the  X,  Y  and  Z 
axes  can  be  combined  into  a  single  vector  equation 


y  (  Fl  S  3  )i  =  Mp  ( Ac  +  gk)+  Fext'*'  Egr'*'  Etan"*"  Ecor'*'  Ecaitr  (69) 
i  =  l 


where  the  vector  F  gr ,  the  connector  gravitational  force  vector,  describes  the  forces  applied 
to  the  platform  by  the  gravitational  acceleration  acting  on  the  masses  M  g ,  M  d  and  M  5 


i  =  l 


g[MeE  +  MdD  +  Mbbl] 


[s2zS2  +  S23zS23] 


(69.  a) 


The  connector  tangential  acceleration  force  vector,  F  tan ,  describes  the  forces  applied  to  the 
platform  by  the  angular  acceleration  fic  12  acting  on  the  rigid  bodies  of  the  connector 


Etan  =  £ 
i  =  l 


MeE2  +  MdD^  +  Mbbl2+  IlxxS23x^-^  DzzS3x^ 


aiS2 


Ill 


I 

i  =  l 


MeE^  +  MdD^  +  Mbbl^  +  II XX 


a2S23 


(69.b) 


The  connector  Coriolis  acceleration  force  vector,  Few ,  describes  the  forces  applied  to  the 
platform  by  the  Coriolis  acceleration  acting  on  the  rigid  bodies  on  the  connector 


Ecor  = 

i  =  l 


2[MeEE+Mdr)D] 


[  W1S2  +  102823] 


(69.C) 


The  connector  centrifugal  acceleration  force  vector,  F  cent ,  describes  the  forces  applied  to 
the  platform  by  the  centrifugal  acceleration  acting  on  the  rigid  bodies  on  the  connector 


Ecent  =  5^ 
i  =  l 


S3xS23x  (MeE^-HMdD^-HVlbbl^)  ^^25^3 

L 


2s3^(MeE2  +  MdD-  +  Mbbl^) 


i  =  l 


Wl(02  §2 


I 

i  =  l 


S3xS23x(Hxx-Ilzz).  0Ji2s23 


i  =  l 


2s23x  S3x  (Ilzz-Ilxx) 


COi  (02  §2 


(69.  d) 


5.6.3.2  Rotation  about  the  X.  Y  and  Z  axes 

The  general  equation  of  motion  for  the  rotations  about  the  X,  Y  and  Z  axes  is  given  by 
(k  =  22, 23  and  24) 
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6 

Z 

i  =  l 


(70) 


The  first  three  terms  of  the  above  equation  can  be  evaluated  using  equations  (27),  (28)  and 
(29)  for  the  velocity  partial  derivatives  with  respect  to  the  generalized  speeds  u  22 ,  u  23  and 
u  24.  These  velocity  partial  derivatives  have  the  following  general  forms 


^  =  ^[UkS2  +  QkS23] 


where  (he  coefficients  U  k  <uid  Q  k  are  given  by 


U221 

Rpcy 

S2z  - 

Rpcz 

S2y 

U23 

=  (Rpc''S2)  = 

Rpcz 

S2x  - 

Rpcx 

S2z 

U24J 

Rpcx 

S2y  - 

Rpcy 

S2x 

4  ; 


Rpcy  S23z  "  Rpcz  S23y 
Rpcz  S23x  -  Rpcx  S23z 
Rpcx  S23y  -  Rpcy  S23x_ 

The  fourth  term  of  equation  (70)  can  be  evaluated  using  equations  (20),  (21)  and  (22)  for 
the  angular  velocity  partial  derivatives  with  respect  to  the  generalized  speeds  u  22  >  u  23  and 

U24.  These  velocity  partial  derivatives  have  the  following  general  forms 


Q22 
Q23 
Q24 


=  (Rpc'^S23)  = 
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Using  equation  (54),  the  fifth  term  of  equation  (70)  can  be  written  as 


-I'c 

auk 


5(0 

du  w 


lext  +  £  (FlSo3)i  -  «  (w  '<Ip"-w) 

i  =  1 


Given  the  fact  that  these  velocity  partial  derivatives  have  the  same  structure  as  the 
velocity  partial  derivatives  with  respect  to  the  generalized  speeds  u  19 ,  u  20  and  u  21, 

equation  (70)  can  be  simplified  using  a  derivation  parallel  to  the  one  outUned  in  the 
previous  section.  The  equation  of  motion  for  the  rotations  about  the  X,  Y  and  Z  axes  can 
be  written  as 


2^  (  Fl  S  o3  )i  -  Text     Tp  +  Tgr  +  Ttan      loor  Icentr 

(71) 

i  =  1 


where  T  ext  is  the  external  torque  applied  to  the  platform.  T'p  is  the  inertial  torque  of  the 
platform  which  is  given  by 


T„  = 


5co 


p  auk 


a  •  Ip  +  (  w  Ip'iiil) 


(71.a) 


The  connector  gravitational  torque  vector,  Tgr ,  describes  the  torques  applied  to  the 
platform  caused  by  the  gravitational  acceleration  acting  on  the  rigid  bodies  of  the  connector 


T    -  V    [g[MeE-^MdD+Mbbl]  ^    ,  . 


i  =  l 


i  =  l 


g[MeE  +  MdD+Mbbl] 


S23z(Spc'<S23l) 


(71.b) 
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The  connector  tangential  acceleration  torque  vector,  T  tan  >  describes  the  torques  applied  to 
the  platform  by  the  angular  acceleration  a  12  acting  on  the  rigid  bodies  of  the  connector 


i  =  1 


|.  [MeE2.MdD^^Mbbl^.Ilxx,^^(R^.,^3)]  (71.,) 
i  =  l  ^  ^  ^> 


The  connector  Coriolis  acceleration  torque  vector,  Tcor  >  describes  the  torques  applied  to 
the  platform  by  the  Coriolis  acceleration  acting  on  the  rigid  bodies  of  the  connector 


Icor  - 

i  =  l 


2[MeEE  +  MdDD 


Wl(Rpc'<S2)  +  C02(Rpc''S23)] 


(71. d) 


The  connector  centrifugal  acceleration  torque  vector,  T  c^it  >  describes  the  torques  applied 
to  the  platform  by  the  centrifugal  acceleration  acting  on  the  rigid  bodies  on  the  connector 

i  =  l  ^  ^ 


I 

i  =  l 


2s3x(MeE2  +  MdD2  +  Mbbl2) 


Wl  C02(Rpc''S2) 


6 

I 

i  =  l 


  Wi  (Kpc'<S23j 


i  [123XA3X  (Ilzz-Uxxl)  cOiC02(Rpc'<S2)" 
i  =  l  ^  ^ 


(71.e) 
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5.6.4  Summary  of  the  Equations  of  Motion  for  the  Platform 

The  equations  of  motion  describing  the  platform  translation  and  rotation,  equations  (69) 
and  (71),  can  be  combined  into  one  single  vectorial  equation 


£  (Fi  Ssli  =  Wext  +  Wp  +  Wgr  +  Wtan  +  Wcor  +  Wceot  (72) 


i  =  l 

where  the  vector  S  3  is  the  Plucker  line  coordinates  of  each  of  the  connectors. 

The  vector  Wext,  the  extanal  wrench,  describes  the  forces  and  torques  applied  to  the 

platform  from  external  sources  such  as  the  cutting  forces  generated  in  milling  operations. 

The  vector  Wp,  the  platform  inertial  and  gravitational  wrench,  quantifies  the  forces 
generated  by  the  acceleration  of  the  platform 


The  connector  gravitational  wrench  W  gr  describes  the  forces  and  torques  t^plied  on  the 
platform  by  the  gravitational  acceleration  acting  on  the  rigid  bodies  of  the  connector 


6 


Mp(Ac  +  gl) 
a  •  Ip  +  (to  X  Ip'tOl) 


(72.a) 
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g[MeE  +  MdD+Mbbl] 
L 


Wgr=  I 


S2zS2  .+ 


1 


i  =  l 


6  r 


g[MeE  +  MdD+Mbbl] 
L 


I 


S  232^23 


(72.b) 


i  =  l 


where  the  vectors  are 


§2 
Epc"  S2 


(72.C) 
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The  connector  tangential  acceleration  wraich  Wtan  determines  the  forces  and  torques 
applied  to  the  platform  by  the  inertial  forces  produced  by  the  angular  acceleration  a  12 
acting  on  the  rigid  bodies  of  the  connector 


Wtan  =  £ 
i  =  l 


MeE2  +  MdD2+Mbbl2+  DxxS23x2+  DzzSjx^    „  c. 

L 


6 

I 

i  =  l 


MeE2  +  MdD^  +  Mbbl^+  Ilxx 


2  »23 


(72.  d) 


The  connector  Coriolis  acceleration  wrench  W  cor  determines  the  forces  and  torques 
applied  to  the  platform  by  the  inertial  forces  produced  by  the  Coriolis  acceleration  acting  on 
the  rigid  bodies  of  tiie  connector 


^  _  ^  [2[MeEE  +  MdDD 
JlLcor  — 


i  =  1 


[  CO  1  S  2  +  W2  S  23] 


(72.e) 


The  connector  CCTitrifiigal  acceleration  wrench  Wcent  determines  the  forces  and  torques 
applied  to  the  platform  by  the  inertial  forces  produced  by  the  centrifugal  acceleration  acting 
on  the  rigid  bodies  of  the  connector 


Wcent  =  I 
1  =  1 


^    ^  S3xS23x  (MeE^  +  MdD^  +  Mbbl^)  ,_2 


W  r  S  23 
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6  r 


S23x  S3x  (Ilzz-flxxl) 
L 


I 


CO  1  CO2S  2 


(72.  f) 


i  =  l 


Equation  (72)  illustrates  the  high  degree  of  coupling  that  exits  in  the  platform  equations 
of  motion.  Each  connector  will  have  to  produce  a  force  that  is  a  function  of  the  location 
and  motion  of  the  other  connectors  and  the  platform.  The  dynamic  coupling  is  a  function 
of  the  system  parameters  such  as  connector  length,  moment  of  inertias  and  masses.  For 
light  loads,  the  connectors  do  not  have  to  be  so  sti-ong  which  reduces  the  connector  masses 
and  moment  of  inertias.  For  heavy  loads,  the  connectors  must  be  stronger  and 
consequentiy  their  masses  and  moments  of  inertias  are  increased.  Therefore  platforms 
designed  for  heavy  loads  will  exhibit  a  higher  degree  of  coupling  than  the  platform 

designed  for  light  loads.  ,  , 

The  dynamic  coupling  is  also  a  consequence  of  the  motion  of  the  platform,  which  . 

s 

determines  the  velocity  and  acceleration  of  the  connectors.  In  high  speed  applications  tiie 
connector  velocity  and  acceleration  increase  and  tiie  coupling  will  be  more  significanL  In 
low  speed  applications,  the  connector  velocity  and  acceleration  are  smaller  and  the 
coupling  caused  by  the  tangential  acceleration,  Coriolis  acceleration  and  centrifugal 
acceleration  may  not  be  not  an  important  factor.  The  gravitational  acceleration  will  cause 
coupling  regardless  of  the  motion  of  the  platform  and  should  be  a  concern  for  any  type  of 
applicatitMi. 

5.7  Dynamic  Model  Validation 

A  major  issue  when  modeling  a  dynamic  system  is  to  be  able  to  determine  whether  or 
not  the  model  itself  is  correct  This  requires  a  comparison  with  another  method  such  as 
Newton's  2nd  Law  or  Lagrange's  Equatiwi.  The  equations  of  motion  of  the  manipulator 
will  be  verified  using  Newton's  2nd  Law. 
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5.7. 1  Equation  of  Motion  for  the  mass  M 

The  sum  of  forces  acting  on  the  mass  M  e  was  determined  in  Section  4.6 

Fe  =  [Fa-CtE-KL5L]s3-[Meg]k 

The  sum  of  forces  must  be  equal  to  the  mass  M  e  multiplied  by  its  acceleration.  The 
acceleration  vector,  which  was  determined  in  Section  3.5,  is  given  by 

Ae  =  E  S3 +2E((0i  §2  + W2S  23)  + E(a  182  +  02823)  + 

e(2(Oi(02(s  1*  S3)s2  +  Wt(s  1  *  8  31)8  1  -  (  W  1  +  (o|l)s  3  ) 

The  force  is  equal  to  the  product  of  the  acceleration  and  the  mass 

FaS3  =  [CtE+KL6L]  83+  Megk+MeE  S3 +  2MeE(  (01  S2 +  102823)  + 

MeE{a  IS  2  +  a2S23  + 2(0  1  W2(s  1-83)82  + Wi(s  1  -83)8  1  -(wi  +(02)53) 

This  equation  can  be  divided  into  a  component  parallel  to  the  connector  and  a  component 
perpendicular  to  the  connector.  The  parallel  component  is 

Fa  =CtE+KL6L  *  Me[E  +  gS32+  e((o^  83^2.  (io|  +  (oi))] 

This  equation  described  the  motion  of  the  mass  M  e  along  the  connector.  It  is  the  same  as 

equation  (61)  which  is  the  equation  of  motion  derived  by  using  Kane's  Method. 

The  component  perpendicular  to  the  connector  generates  an  equilibrant  force  at  the  point 
joining  the  connector  with  the  platform.  This  will  be  covCTed  in  the  verification  of  the 
platform  equations  of  motion. 
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5.7.2  Equation  of  Motion  for  the  mass  M  ^ 

The  sum  of  forces  acting  on  the  mass  M  a  was  determined  in  Section  4.6 

Ed  =  [-Cd(D-L)  -Kd6d]  S3-[Mdg]k 

The  sum  of  forces  must  be  equal  to  the  product  of  the  mass  and  the  acceleration.  The 
acceleration  vector,  which  was  determined  in  Section  3.5,  is  given  by 

Ad  =  DS3  +2D(WiS2  + W2S23)+D(aiS2  +  a2S23)+  I  : 

d(2coi  C02(s  i-S3)S2-^  wi(s  1  -salsi-lio^  +  collss) 

The  force  is  equal  to  the  product  of  this  acceleration  and  the  mass 

[-Cd(D-L)  -Kd6d]  §3  =  Mdgk  +  MdD  S3  +2MdD(  C01S2  + 102523)  + 

MdD(aiS2  +  a2S23  +  2(j0i  co2(s  i  •  s  3)82  +      (s  i  •83)8  1 -(  w ?  +  w|)s  3) 

As  done  in  the  previous  section,  this  equation  can  be  divided  into  a  component  parallel  to 
the  connector  and  a  component  perpendicular  to  the  connector.  The  parallel  component  is 

[-Cd(D-L)  -Kd6d]  =  Mdli)  +  gS3^+  d((o1  s^^^  -        +  o^l))] 

This  equation  described  the  motion  of  the  decoupling  stage  mass  along  the  connector.  It  is 
the  same  as  equation  (62)  which  is  the  equation  of  motion  for  the  mass  M  d ,  daived  using 

Kane's  Method. 

The  component  perpendicular  to  the  connector  generates  an  equilibrant  force  at  the  point 
joining  the  connector  with  the  platform.  This  will  be  covo^ed  in  the  verification  of  the 
platform  equations  of  motion. 


120 

5.7.3  Equations  of  Motion  of  the  Platform 
The  sum  of  forces  on  the  platform  is  given  by 

6 

rp  =  Fext-Mpg+  Fl 

i  =  l 

Where  F  ext  is  the  external  force  applied  on  the  platform,  and  F  l  is  the  force  that  each 
connector  applies  to  the  platform.  This  last  force  can  also  be  divided  into  two  components 

El  =Fl  +  Fl 

Where  F'l  is  the  parallel  force  component  which  is  applied  by  each  of  the  connectors  to  the 
platform  along  the  direction  of  the  connector,  s  3.  This  force  is  generated  by  the  coupling 
stage  stiffness  and  damper  along  with  the  decoupling  damper  as  discussed  in  Section  4.6. 
The  expression  for  this  force  is  given  by 

El  =[Cd(D-lJ)  +  Cc(H-Ll)  +  Kc6c]s3  (73) 

The  perpendicular  force  F"l  is  applied  by  each  of  the  connectors  to  the  platform  along  a 

direction  perpaidicular  to  the  connector.  This  force  is  generated  by  the  gravitational, 
Coriolis,  centrifugal  and  angular  acceleration  components  acting  on  the  rigid  bodies  of  each 
connector.  The  accelaation  of  any  rigid  body  on  the  connector  at  a  distance  U  from  the 
base,  as  shown  in  figure  5.5,  is  given  by 

A  =  gk  +  Us3+2lJ(coiS2  +  W2  s  23I)  +  U(aiS2+a2S23)  + 

U(2(0i  t02(s  1  •  §3)82  +  w?  (s  1  •  s  3i)s  1  -((Oi  +  (02l)s  3  )  (74) 

The  inertial  force  of  a  body  is  the  product  of  its  mass  and  acceleration.  The  inertial  force  of 
the  mass  M  on  the  connector  is  given  by 
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Figure  5.5  -  Platform  and  connector  with  Rigid  Body 

Fi  =  -MA  =  -M[gk  +  ijs3  +  2U(o3iS2  +  t02S23)  +  U(aiS2  +  a2S23)l- 

Mu(  2(01  (j02{s  1  •  s  3)5  2  +  ooi  (s  1  •  s  3)5  1 -( CO  1  +  w^js  3I)  (75) 

The  inertial  torque  of  a  body  is  generated  by  its  angular  velocity  and  acceleration 

Ti=-ai2*r-  w  12'*  I" 'CO  12 

where  I"  is  the  inertia  dyadic  of  the  body.  Using  the  expressions  for  the  inertia  dyadic 
given  in  equations  (56),  (57)  and  (58),  the  inertial  torque  can  be  written  as 

ll  =  Ilxx[  iil2  '823]  S23  +  Ilxx[wi2  X  S23][S23*W12]  + 
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Ilxx[  ai2  •S2]  S2+Ilxx[wi2  ^  S2][s2*Wl2]  + 
Dzz[  a  12  '83]  S  3  +  Ilzz[wi2  X  S  3  ][s  3*  (O12]  (76) 
The  inertial  force  Fi  produces  a  torque  about  the  base  of  the  connector  (see  Figure  5.6 ) 

US3X  Ei 

This  torque  together  with  the  inertial  torque  T  i  will  be  balanced  by  the  torque  produced  by 
the  force  F"l  as  shown  in  figures  5.5  and  5.6 

Ls3^Fl=(Us3x  Fi)+Ti  t  f  , 


S3 


Figure  5.6  -  Forces  and  Torques  acting  on  the  connector 
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The  force  F''l  can  be  determined  by  taking  the  vector  product  of  s  3  and  the  above  equation 


S3  X  [Ls3  X  El  J  =  S3  X  [(Us3    rii)  +  li: 


which  gives  the  following  expression  for  F''l 


f"  -S3^[(US3^Fi)-hTi: 


This  force  can  be  expanded  by  using  to  the  expressions  for  the  inertial  force  and  torque, 
equations  (75)  and  (76) 


r  g  M  U  r 


MU2+  IxxS23x2  +  IzzS3x2  ^  MU^  +  I^x    „  ^ 

 — — ^  ^ — a  1  s  2   J —       2  S  23 


^^^[W1S2+  t02S23] 


2  S  3^MU^  +  2s23xS3x(Izz-Ixx) 


S3x  S23x  (MU^  +Ixx  -Izz)  ^^.2^ 

L  i  -23 


(77) 


The  sum  of  forces  on  the  platform,  which  is  equal  to  Uie  product  of  its  acceleration  and 
mass,  can  now  be  written  as 


Eext-Mpg+  I  El  +  I  El=  MpAc 
i=l  i=l 


The  above  equation  can  be  rewritten  using  all  the  rigid  bodies  of  the  connector 


{FLS3)i  =  Fext  +  MpAc  +  Mpg  + 

i  =  l 
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I 

i  =  l 


g[MeE+MdD+Mbbl] 


[  S2zS2  +  S23z  §23] 


6 

I 

i  =  l 


MeE2  +  MdD2  +  Mbbl2  +  IlxxS23x^+Il^S3xi 


aiS2 


1 

i  =  l 


MeE^  +  MdD^  +  Mbbl^+  II 


XX 


a2S23 


V    f2[MeEE  +  MdDDl  r 

\  i  I  (i3  1  S  o  + 

i  =  l 


[  10152  +  W2S23; 


J 1 


I 

i  =  l 


2s3^(MeE-  +  MdD-+Mbbl-) 


Wl  (02  §2 


=  1 


2s23x  S3x(Ilzz-nxx) 


Wi  (02  §2 
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I 

i  =  l 


S3xS23x  (MeE^-HMdD--^Mbbr-)  ^^2^23 


i  =  1 


S23xS3x(^xx  -Hzzl)  ioi2s23 


This  is  the  same  equation  (69)  obtained  by  using  Kane's  Method. 

The  sum  of  torques  about  the  platform  center  of  gravity  can  be  written  in  the  form  (see 
figure  5.7 ) 
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Text  +  I  EpcxFl^  £  Spc''Fl=  fl-Ip"+  40  "Ip-'CO 

i  =  l  i  =  l  >     ■  ." 

where  the  T  ext  is  the  external  torque  applied  to  the  platform  and  the  right  hand  side  of  the 
equation  is  the  inertia!  torque  of  the  platform.  Using  the  expressions  derived  previously  for 
the  forces  F'l  and  F'l  ,  the  above  equation  can  be  expanded  to 

6 

£  (FLSo3)i  =  lext  +  a-Ip"+  02'<Ip"-Si2  + 

i  =  l 


+ 


Figure  5.7  -  Connector  Forces  acting  on  the  platform 
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i  =  l  ^ 


I 

i  =  1 


2[MeEE  +  MdDD] 


Epc'*[  W1S2  +  W2S23] 


-'1 


i  =  l 


2s3^(MeE2  +  MdD^  +  Mbbl2)  ^ 


Kpcx  Wl  (O2S2 


i  =  l 


2s23xS3x(Ilzz-Ilxx)  R^.o^,o^^S2 


6 

I 

i  =  l 


i  =  l 


S3xS23x  (MeE^+MdD^  +  MbbP)  ^ 


''''  —  S  pc     W  r  S  23 


pc     W  1    S  23 


This  is  the  same  as  equation  (71)  which  was  derived  using  Kane's  Method.  The  validation 
of  the  equations  of  motion  is  complete  and  it  has  been  demonstrated  that  the  same  results 
are  obtained  using  two  different  formulations. 


5.8  Summary 

Kane's  Method  has  proven  to  be  an  effective  formulation  for  obtaining  the  explicit 
equations  of  motion  for  a  parallel  manipulator.  This  method  is  more  effective  for  parallel 
manipulators  than  Lagrange's  formulation.  One  of  the  main  reasons  is  that  setting  up  the 
equations  of  motion  with  Lagrange  requires  several  operations  with  the  velocity  and 
displacement  expressions  as  outlined  in  section  5. 1  [  1 3, 26].  These  expressions  are  rather 
elaborate  for  parallel  manipulators  (see  Section  3.4),  as  compared  to  serial  manipulators  for 
which  Lagrange  has  proven  to  an  effective  formulation  technique.  Kane's  Method  uses  the 
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velocity  expression  for  obtaining  the  velocity  partial  derivatives  which  was  shown  here  to 
be  a  simple  task.  This  partial  derivatives  turn  out  to  be  the  coefficients  of  the  velocity 
equations. 

Kane's  Method  is  similar  to  the  Newton-Euler  formulation  since  both  methods  require  a 
force  and  torque  analysis.  The  main  reason  that  Kane's  Method  was  used  instead  is  that  it 
is  a  more  systematic  formulation,  which  uses  the  velocity  and  angular  velocity  partial 
derivatives  for  eliminating  the  workless  constraints.  In  the  Newton-Euler  formulation  these 
constraints  have  to  be  ehminated  by  combining  equations,  a  non  systematic  process  which 
can  prove  to  be  difficult  and  time  consuming.  The  Newton-Euler  formulation  was  used 
here  to  validate  the  equations  of  motion  which  have  already  been  derived  using  Kane's 
Method.  The  results  obtained  using  Kane's  Method  offered  the  insight  for  setting  up  the 
equations  of  motion  with  Newton-Euler,  which  saved  a  considerable  amount  of  work. 
This  insight  would  not  be  available  if  the  Newton-Euler  formulation  was  used  from  the 
outset.  '         •  -    •  , 

This  work  proves  that  selection  of  the  formulation  method  is  very  important 
consideration  far  dynamic  modeling.  This  selection  is  heavily  influenced  by  the  type  of 
kinematic  chain  the  manipulator  is  based  on  (serial  or  parallel  kinematic  chain). 


CHAPTER  6 
DYNAMIC  SIMULATION  ALGORITHM 


Once  the  dynamic  model  has  been  derived,  a  simulation  algorithm  can  be  developed. 
The  objective  is  to  determine  the  required  actuator  forces,  power  and  frequency  response 
for  a  given  spatial  parallel  manipulator  and  the  required  task.  Parameters  such  as 
dimensions,  platform  mass,  connector  stiffness  and  transmission  damping  coefficients  (see 
Chapter  2  for  more  details  on  all  the  parameters)  will  be  specified. 

The  first  part  of  the  simulation  will  determine  the  kinematic  state  of  the  connectors 
(positions,  velocities  and  accelerations)  using  the  motion  or  task  description  of  the 
platform.  The  second  part  of  the  simulation  will  determine  the  forces  and  moments  acting 
on  the  system  and  will  determine  the  required  actuator  response  for  the  desired  task. 

6.1  Motion  and  Task  Planning 

There  are  different  types  of  task  that  the  manipulator  can  perform.  The  platform  can  be 
required  to  carry  a  load  or  to  counteract  an  external  force  such  as  those  generated  when 
machining.  In  this  case  the  external  force  and  torque  are  specified  along  with  the  desired 
output  resultant  force  and  torque.  This  is  also  known  as  force  control.  The  platform  can 
also  be  required  to  move  a  body  through  a  prescribed  motion  such  as  that  of  a  flight 
simulator.  This  type  of  task  requires  motion  control.  Another  appUcations  might  require 
the  platform  to  operate  in  a  combined  or  hybrid  force/motion  control  mode.  Polishing  a 
lens  or  machining  a  complex  contour  requires  that  the  platform  controls  the  contact  forces 
between  the  end  effector  and  the  workpiece  while  at  the  same  time  executing  a  given  motion 
profile. 

Although  more  emphasis  is  given  to  the  areas  of  motion  and  hybrid  control,  the 
simulation  algorithm  is  designed  to  use  any  of  the  mentioned  tasks  as  the  input 
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6.2  Inverse  Kinematic  Simulation  Algorithm 

The  inverse  kinematic  analysis  wiU  be  done  in  two  parts.  Firstly  it  is  necessary  to 
determine  the  motion  of  the  platform  (location,  velocity  and  acceleration)  based  on  the 
motion  planning  parameters.  Secondly  part  of  the  inverse  kinematic  analysis  will  determine 
the  motion  of  each  connector.  Most  of  the  equations  used  in  this  section  have  been  derived 
and  discussed  in  detail  in  Chapter  3. 

6.2. 1  Platform  Inverse  Kinematics 

Two  basic  platform  motions  (see  Section  3.6)  will  be  considered  for  the  inverse 
kinematic  analysis.  The  first  is  a  rectilinear  motion  and  the  second  is  a  curvilinear  motion. 
For  both  cases  the  initial  position  of  the  centerpoint  c ,  C  o,  and  the  initial  orientation  of  the 
platform,  [R]  o,  will  be  specified.  Using  these  initial  quantities,  the  initial  position  of  any 
point  on  the  platform  can  be  determined  by 

Po=£o^  [RloSpc/m  (1) 

where  Rpc/m  is  the  position  vector  of  point  p  with  respect  to  centerpoint  c  defined  with 

respect  to  the  moving  coordinate  frame  as  explained  in  Section  3.2.  This  vector  is  a 
constant  which  is  determined  by  the  platform  dimensions. 

6.2. 1 . 1  Rectilinear  Motion 

The  parameters  required  to  specify  a  rectilinear  motion  are  the  total  displacement  AS, 

the  axis  of  translation  w  (  see  Figure  6.1 )  and  the  time  period  T  (see  Section  3.6).  The 
position,  velocity  and  acceleration  of  any  point  p  on  the  platform  can  be  determined  by 
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Xf 

Figure  6. 1  -  Rectilinear  Motion 
Ap(t)  =  ^(^|)'cos(^i)w     .  .  ■<4) 

For  this  type  of  motion,  the  orientation  of  the  platform  remains  constant  and  the  rotation 
matrix  is  not  used. 

6.2.1.2  Rotational  Motion 

The  parameters  required  to  specify  a  rotational  motion  are  the  total  angular  displacement 
A6,  the  axis  of  rotation  s,  the  distance  r  c  from  the  centerpoint  c  to  the  axis  of  rotation 

( see  Figure  6.2),  and  the  time  period  T  as  mentioned  in  Section  3.6.  The  position, 
velocity  and  acceleration  of  any  point  on  the  platform  can  be  determined  by 

P  =  Po  +  Rpc  (5) 
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instantaneous 
axis  of 
rotation 


center  of 
rotation 


Figure  6.2  -  Curvilinear  Motion 


Yp=  [(rc-Rpci)xco] 


(6) 


Ap=  iOx[(rc-Rpc)xcs2] +(rc-Spc)xfl 


where  0,  co  and  a  are  the  platform  angular  displacement,  velocity  and  acceleration  vectors 


fi{t)  = 


l-cos(^)]s 


to(t)  =  ^^[sm^^ 


(fl) 


(9) 


2T2 


cos 


(10) 


The  relative  position  vector  Rpc  ,  which  changes  as  the  platform  moves,  is  determined  by 


S  pc  -  [  R  ]  o  [  R  ]  S  pc/m 


(11) 
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where  [R]  o  describes  the  initial  orientation  of  the  platform,  R  pc/m  is  the  relative  position 
vector  with  respect  to  the  moving  coordinate  frame,  and  [R]  is  the  rotation  matrix 


[R]  = 


Sx^vsn9  +cos6  Sx  Sy  vsn6  -  sin6  Sx  Szvsn6  +  Sysin6 
Sx  Sy  vsn6  +  Sz  sinG  Sy^vsnO+cosB  SySzVsnO  -SxSin6 
Sx  Sz  vsn6  -  Sy  sin6     Sy  Sz  vsn6  +  Sx  sin6  Sz^vsn6+cos0 


(12) 


6.2.2  Connector  Inverse  Kinematics 

The  Pliicker  line  coordinates  for  each  connector  can  be  determined  by  using  the 
following  equation 

^    _[P  B]  .  _Bx[P-Bi]  j3 

where  P  is  determined  using  equation  (2)  or  (5)  depending  on  the  type  of  motion  ;  and 
B  is  the  position  of  the  connection  with  the  base.  The  lengtii  of  a  connector  is  given  by 

L=|P-B|  (14) 

The  velocity  of  point  p  on  the  connector  can  be  determined  using  either  equation  (3)  or 
(6).  The  velocity  of  the  prismatic  joint  in  the  connector  can  be  determined  by 

Y3  =  (Yp-S3l)s3     _  (15) 

The  angular  velocity  of  the  Hooke  joint  located  at  the  base  of  the  connector  is  given  by 

to  12  =  401  +4222  (16) 
where  the  components  of  this  vector  are  given  by  (see  Sections  3.3  and  3.4) 


(17) 
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i02  =  |^^)s2  (18) 


The  acceleration  of  point  p  on  the  connector  can  be  determined  using  either  equation  (4) 
or  (7).  The  acceleration  of  the  prismatic  joint  in  the  connector  can  be  determined  by 

A3  =  (A*p-S3l)s3  (19) 

where  A*p  is  given  by 

AJ  =  Ap-(Oi  (  s  1  X  Sol)- wli  S2X  So2l)  - 

2(j0iS  1  x(c02So2+  V3S3)  -  2C02S2X  V3S3  (20) 

The  angular  accelo-ation  of  the  Hooke  joint  located  at  the  base  of  the  connector  is  given  by 

a  12  =  a  1  +  a2  +  CO  1 002  (  s  1  X  s  2)  (21) 

The  angular  accelerations  a  1  and  a  2  are  given  by 


fil=|^^)si  (22) 


a2  =  |^^|s2  (23) 


6.3  Equations  of  Motion  for  the  Manipulator 
The  equations  of  motion  were  derived  in  Chapter  5.  Since  the  system  has  24  degrees 
of  freedom,  the  dynamic  model  must  have  24  equations  of  motion.  The  dynamic  behavior 
of  the  platform  is  described  by  the  following  set  of  equations 


134 


6 

I 

i  =  1 


i  (FlSsIi  =  Wext+  Wp  +  Wgr  +  Wtan  +  Wcor  +  Wcent  (24) 


where  the  dual  vector  S  3  contains  the  Pliicker  line  coordinates  of  each  of  the  connectors. 
The  vector  Wext ,  the  external  wraich,  represents  the  forces  and  torques  applied  to  the 

platform  from  external  sources  such  as  the  cutting  forces  generated  in  milling  operations. 
The  platform  inertial  and  gravitational  wrench,  W  p  ,  quantifies  the  forces  and  torques 

generated  by  the  gravitational  acceleration,  the  angular  velocity  and  the  angular  acceleration 
of  the  platform 


Wp  = 


Mp(Ac  +  g) 
<2  •  Ip"  +  { 40    Ip"  •  w ) 


(24.a) 


The  connector  gravitational  wraich,  Wgr ,  quantifies  the  forces  and  torques  applied  to  the 
platform  by  the  gravitational  acceleration  acting  on  the  rigid  bodies  of  the  connector 


i  =  l 


g[MeE  +  MdD  +  Mbbl]  ^  ^ 


2z^2 


I 

i  =  l 


g[MeE  +  MdD  +  Mbbl] 


S23zS23 


(24.  b) 


where  S  2  and  S  23  are  the  given  by: 


S2  = 


§2 
Spc  "  S  2 


;  §23  = 


§23 
Spc  "  §23 


(24.C) 


The  connector  tangential  accelCTation  wraich,  W  tan ,  describes  the  forces  and  torques 


applied  to  the  platform  by  the  angular  acceleration  a  12  acting  on  the  rigid  bodies  of  the 


connector 


i  =  l 


MeE2-HMdD^  +  Mbbl2+  DxxS23x^-^  UzzS3^2    ^  g 

L 


E 

i  =  l 


M 


eE2-HVIdD^  +  Mbbl2+  Ilxx 


2  »23 


(24.  d) 


The  connector  Coriolis  acceleration  wrench,  Wcor ,  quantifies  the  forces  and  torques 
applied  to  the  platform  by  the  CorioUs  acceleration  acting  on  the  rigid  bodies  of  the 
connector 


Wcor=  I 
i  =  l 


2[MeEE  +  MdDD 


10182  +  1028  23 


(24.e) 


The  connector  centrifugal  acceleration  wrench,  W  cor ,  represents  the  forces  and  torques 
applied  to  the  platform  by  the  centrifugal  acceleration  acting  on  the  rigid  bodies  of  the 
connector 


Wcent=  £ 
i  =  l 


^    ^  S3x  S23x  ( MeE^  +  MdD^  +  Mbbl^  )  ,,.2 


W  1  ^  8  23  I  + 
i 


I 

i  =  l 


2s3JMeE2  +  MdD2  +Mbbl2) 


Wi  (O2S  2 


1  =  1  ^  ^ 
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2^  ^ — - — ^^001(0282 


i  =  l 


(24.  f) 


The  equation  of  motion  for  the  mass  M  d  is 

Md[D+gS3z+D(o^(s3x)2-D((0?  +  03|)  ]  +  Cd(D-L)  +  Kd5d=0  (25) 

where  the  first  time  derivative  of  the  length  of  the  connector  L  is  equal  to  the  velocity  of  the 
prismatic  joint  of  the  connector 

L  =  V3 

The  equation  of  motion  for  the  mass  M  e  is 

Fa=Me[E  +  gS3z+  E  (0?  (  s  3^  )2  -  e(  to?  +  col)  ]  +  C  t  E  +  K 1 61  (26) 

The  last  six  equations  of  motion  can  be  obtained  by  using  the  auxiliary  equations 
derived  in  Chapter  4  -      .  ;       ;  .  •      .  • 

Fl  =  Cd(D-L)  +  Cc(H-L)+Kc6c  (27)  >* 

Kl6l=  Cc(H-L)+Kc6c  (28) 

These  auxiliary  equations  can  be  used  eliminate  the  displacemait  6  l  from  equation  (26) 

and  relate  the  connector  forces  to  the  actuator  forces.  First  use  equation  (28)  to  eliminate 
the  coupling  stage  displacement  and  velocity  from  equation  (27) 

Fl  =  Cd(D-L)  +  KL6L 
Now  rearranging  in  terms  of  the  displacement  6  l 


Kl6l  =FL-Cd(D-L) 
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By  substituting  the  above  equation  into  equation  (26)  and  rearranging,  the  following 
expression  for  the  connector  force  F  l  is  obtained 

Fl  =  Fa-CtE+Cd(D-L)  +  Me[E(col(l-(s3j^)  +  wi)  -E-gSjJ  (29) 

Which  can  also  be  written  in  terms  of  the  actuator  force 

Fa  =  FL  +  Me[E  +  gS32-E((0^(l  -(  83^2)+ lol)]  +  CtE-Cd(D-L) 

This  equation  indicates  that  the  actuator  has  not  only  has  to  produce  the  required  connector 
force,  it  also  has  to  accelerate  the  mass  M  e  and  work  against  the  decoupling  damper  and  the 

internal  friction  of  the  actuator. 

6.4  Development  of  the  Dynamic  Simulation  Software 

The  objective  of  this  algorithm  is  to  determine  the  required  actuator  forces,  power  and 
frequency  response  for  a  given  spatial  parallel  manipulator  performing  a  desired  motion  or 
task.  Parameters  such  as  the  dimensions,  platform  mass,  connector  stiffness  and 
transmission  damping  coefficients  (see  Chapter  2  for  more  details  on  all  the  parameters) 
must  be  specified  by  the  user.  The  numerical  algorithm  for  the  computer  simulation  of  the 
inverse  dynamic  behavior  will  be  developed. 

6.4.1  Static  Solution 

The  initial  or  static  conditions  must  be  calculated  before  the  running  the  dynamic 
simulation.  The  initial  conditions  consist  of  the  position  and  orientation  of  the  platform;  the 
length  and  orientation  of  each  of  the  connectors;  the  position  of  the  rigid  bodies  on  each 
connector;  and  the  initial  actuator  forces.  The  initial  position  and  orientation  of  the  platform 
are  specified  before  running  the  simulation  program,  with  this  information  the  connector 
loigths  and  (xientations  can  be  determined  The  length  of  the  fixed  mass  of  the  connector, 
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bl ,  is  a  fixed  length  and  is  determined  when  designing  the  connectors.  The  initial 
positions  of  the  actuator  and  decoupling  stage  (as  described  by  the  displacements  E  and  D ) 
and  the  actuator  forces  can  be  determined  by  a  static  analysis  of  the  manipulator. 

The  equations  of  motion  can  be  used  for  the  static  analysis  of  the  manipulator  by  simply 
setting  all  the  velocities  and  acceleration  to  zero  (except  of  the  gravitational  acceleration). 
The  connector  static  forces  can  thus  be  calculated  using  equation  which  reduces  to 


I  (FLS3)i  = 
i  =  l 


"  Fext(O) 

+ 

Mpg 

.  Text(O) 

0 

(30) 


Here  F  ext  (0)  and  T  ext  (0)  are  the  static  external  force  and  torque  vectors,  which  depend 
on  the  desired  task  as  outlined  in  Chapter  4.  Equation  (30)  is  a  system  of  six  scalar 
equations  that  can  be  solved  to  determine  the  static  connector  forces  F  l-  The  static  actuator 

displacement  can  be  solved  by  using  the  static  connector  forces  and  equations  (27)  and  (28) 

E=(L-1lo-1co)  +  ^-^^  (31) 

where  1  lo  and  1  co  are  the  the  free  length  of  the  K  l  and  K  c  respectively.  The  decoupUng 
stage  static  displacement  is  given  by 

D  =  U  -  ^^^f^  (32) 

where  1  do  is  the  free  length  of  K  c-  The  static  actuator  forces  can  be  determined  by  using 
equation  (29)  with  all  the  velocities  set  to  zero 

Fa  =  FL  +  MegS3^  (33) 


For  a  dynamic  simulation,  the  static  solution  is  equivalent  to  the  initial  conditions  when  the 
initial  velocities  and  accelerations  are  very  small. 


6.4.2  External  Wrench 

The  expressions  for  the  external  forces  and  torques  were  derived  in  Section  4.2.  For 
the  mirror  polishing  task  the  external  wrench  is  calculated  using 


-F„(Zm  +  nt) 


(34) 


where  F  n  is  the  normal  or  contact  force,  ^  is  the  coefficient  of  friction,  "a"  is  the  distance 

from  the  point  of  contact  to  the  centerpoint  of  the  platform,  and  t  is  the  direction  of  travel. 
For  a  rectilinear  motion  the  axis  of  translation  w  is  the  direction  of  travel,  for  curvilinear 
motion  the  direction  of  travel  is  given  by 


where  F  cutting  is  the  cutting  force. 

6.4.3  Numerical  Solution 

The  equations  of  motion  are  a  set  of  nonUnear  differential  equations.  The  analytical 
solutions  for  these  type  of  equations  can  prove  to  be  tedious  and  complex  as  well  as  the 
implementation  of  the  numerical  solutions  [28].  An  alternate  approach  is  to  use  some 
approximate  method  which  involves  difference  equations  and  to  use  small  time  steps. 

One  of  these  approaches  is  the  Euler  Method  for  numerically  solving  the  differential 
equations.  This  method  involves  calculating  a  new  estimate  for  the  highest  order  time 
derivative  based  on  previous  values  of  the  other  derivatives.  The  new  estimate  for  the 
highest  time  derivative  is  then  used  to  calculate  new  estimates  for  the  lower  order  time 
derivatives.  Using  the  equation  of  motion  for  the  decoupling  stage,  given  by  equation 


t  =  Z 


m 


The  external  wrench  for  machining  is  given  by 


(35) 


(25),  the  new  estimate  for  the  acceleration  can  be  written  as 
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„        _  Md  Dold[(  tOi,nevv  + W2,new)  "  ^  i,  new(  S3x,  newl)^  ] 


'new 


Md 

MdgS3z,  new  +  Cd(  Dold"  V3,  new  )  +  KdSd,  old 


M  ^^^^ 
Md 


New  values  are  used  for  the  angular  velocities  to  1  and  to  2,  for  the  connector  velocity  V  3 

and  the  line  coordinates  s  3  since  these  can  be  determined  by  the  inverse  kinematic  analysis. 
The  use  of  the  latest  values  will  improve  the  estimate  for  the  acceleration.  Using  this  new 
estimate  for  the  acceleration,  a  new  estimate  for  the  veltx^ity  and  displacement  of  the 
decoupling  stage  can  be  obtained 

Dnew  =  Dnew  At  +  Dold  (37) 
Dnew  =  Dnew  At  +  Dold  (38) 

where  At  is  the  time  step  or  increment  used  in  the  numerical  method.  The  size  of  the  time 

step  selected  must  be  5  to  10  times  smaller  than  the  shortest  event  to  be  considered  [29]. 
Using  the  equation  of  motion  for  the  connector's  equivalent  mass,  given  by  equation  (29), 
the  new  estimate  for  the  acceleration  can  be  written  as 


_  Faoid-Fi,  old- Ct Bold-  Cd(Doid- V3,  new) 


M 


e 


Eold(       new(l  -  (  S  3x,  new)^)  +  ^2,  newj  "  g  S  3z.  new  ]  (39) 


Using  this  new  estimate  for  the  acceleration,  a  new  estimate  for  the  velocity  and 
displacement  of  the  actuator  can  be  obtained 
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Enew  =  Enew  At  +  Eold 


(40) 


Enew  -  Enew  At  +  Eold 


(41) 


The  new  values  for  the  connector  forces  F  l  can  be  determined  by  using  equation  (24) 


5^  (  Fl,  new  S  3,  new)i  -  W.&xt,  new  Wp,  new  +  Wgr,  new 
i  =  l 


tan,  new  cor,  new     ^  cent,  new 


(42) 


The  six  wrenches  on  the  right  hand  side  of  this  equation  are  given  by 


W 


p,  new 


Mp(Ac,  new+g) 
a  new  •  Ip"  +  (  Wnew     Ip"  *  Wnew  ) 


i  (42.a) 


W 


gr.new  - 

i  =  l 


g  [  MgEnew  +  MdDnew  +  Mbbl] 


S  2z,  new  §  2,  new 


'new 


I 

i  =  l 


g  [  MeEnew  +  MdDnew  +  Mbbl 


S  23z,  new  §  23,  new 


(42.  b) 


W 


tan,  new  — 

i  =  l 


MeE  new    MdDnew  Mbbl^ 


1,  new  S  2,  new 


new 


6 

I 

i  =  l 


II XX  S  23x,  new^     ^^zz  ^  3x,  new^ 


'  new 


I 

i  =  1 


MeEitew  +  MdDLw  +  Mbbl^  +  Uxx 
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«  2,  new  S  23,  new 


■new 


(42.C) 
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W 


cor,  new  —  ^ 
i  =  l 


2[MeEiiewEnew  ] 


^  new  E  new  c»        -i./,^        c^-.  1 

J  L  W  1,  new  »  2,  new  +  W  2,  new  »  23,  new  J 

i^new 


I 

i  =  l 


2[MdDnewDnew] 
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S  3x,  new  S  23x,  new  (  H  zz  "  H  xx) 


W  1,  new  W2,  new S  2,  new 


(42.  e)  4^ 


Once  the  wrenches  are  calculated,  the  connector  forces  are  determined  by  solving  equation 
(42)  using  a  numerical  solution  for  a  system  of  linear  equations  [28]. 

The  new  estimate  for  the  actuator  force  can  be  calculated  with  the  equation  (29) 

Fanew  =  Fl,  new  +  Ct  Enew-  C  d(  Dnew  "  V3,  new)  +  Mg  Enew  + 


Me[  g  S3z,  new    ^new{<^],  new((  S3x,  new)^  "  H)"  ^2,  new  (43) 
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The  required  power  output/input  for  each  actuator  can  be  calculated  using  the  following 
equation 

Power  new  =  Fa  new  Enew  (44) 

6.5  The  Dynamic  Simulation  Software 

Prior  to  executing  the  manipulator  dynamic  simulation  software,  the  user  has  to  provide 
the  motion  and  task  planning  parameters;  the  geometric  parameters  such  as  the  base  and 
platform  dimensions;  and  system  parameters  such  as  mass  and  moments  of  inertia,  spring 
constants  and  damping  coefficients. 

The  simulation  software  was  implemented  by  using  the  following  steps 
Part  A  -  Static  or  Initial  Position  Solution  -  The  system  initial  forces  and  connector  location 
are  determined  by 

1-  Calculate  the  static  connector  endpoint  position  using  equation  (2). 

2-  Calculate  the  static  connector  line  coordinates  and  length  using  equations  (13)  and  (14) 

3-  Calculate  the  static  connector  forces  using  equation  (30). 

4-  Calculate  the  initial  displacements  E  and  D  using  equations  (31)  and  (32). 

5-  Calculate  the  static  actuator  forces  using  equation  (33). 

Part  B  -  Dynamic  Solution:  The  actuator  force  requirements  are  determined  based  on  the 
desired  motion  and  task.  The  initial  time  is  set  to  t  =  0. 

Part  B.l  -  Inverse  Kinematics:  The  connector  location,  velocity  and  acceleration  are 
calculated  using  the  motion  planning  parameters. 

6-  For  rectilinear  motion  determine  the  connector  end  point  position,  velocity  and 
acceleration  using  equations  (2),  (3)  and  (4). 

7-  For  curvilinear  motion  determine  the  connector  end  point  position,  velocity  and 
acceleration  using  equations  (5)  through  (12). 

8-  Calculate  the  connector  line  coordinates  and  length  using  equations  ( 1 3)  and  (14). 

9-  Calculate  the  connector  velocity  vector  V  3  using  equation  (15). 
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10-  Calculate  the  connector  angular  velocity  vector  w  12  using  equations  ( 16)  to  ( 1 8). 

11-  Calculate  the  connector  acceleration  vector  A  3  using  equation  (19). 

12-  Calculate  the  connector  angular  acceleration  vector  a  12  using  equations  (20)  to  (23). 

Part  B.2  -  Inverse  Dynamics:  The  actuator  force  and  power  required  to  generate  the  desired 
motion  are  calculated. 

13-  Calculate  the  new  acceleration,  velocity  and  displacement  of  decoupling  stage  using 
equations  (36)  to  (38). 

14-  Calculate  the  new  acceleration,  velocity  and  displacement  of  actuator  using  equations 
(39)  to  (41). 

15-  Calculate  the  external  wrench  using  equation  (35). 

16-  Calculate  the  new  connector  forces  using  equations  (42)  and  (42.a)  through  (42.e). 

17-  Calculate  the  new  actuator  forces  using  equation  (43). 

18-  Calculate  the  actuator  power  requirements  using  equation  (44). 

19-  Increase  the  the  time  to  t  =  t  +  At,  go  to  step  6. 

The  total  simulation  algorithm  is  outlined  in  Figure  6.3.  This  is  the  basis  for  the 
dynamic  simulation  software  developed  using  ANSI  C  [28, 30]  as  part  of  this  research 
project  and  will  be  further  discussed  in  Chapter  7. 
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Figure  6.3 


-  Dynamic  Simulation  Software 


CHAPTER  7 
TESTING  AND  RESULTS 


The  dynamic  simulation  software  allows  the  the  designer  to  determine  the  actuator 
requirements  for  a  manipulator  performing  a  desired  task  or  motion.  The  first  goal  of 
testing  this  software  is  to  gain  some  understanding  of  the  dynamic  behavior  of  parallel 
manipulators.  As  indicated  in  Chapter  5,  section  5.6,  the  dynamic  model  can  be  written  as: 

6  _ 
£  (piSali  =  Wext  +  Wp  +  Wgr  +  Wtan  +  Wcor  +  Wcent 
i  =  l 

The  last  four  terms  of  this  equations  describe  the  coupling  effects  between  the  connectors. 
These  terms  can  be  grouped  into  an  equivalent  coupling  wrench  as: 

cent 

This  coupling  wrench  is  a  function  of  the  system  geometry,  the  system  parameters  and  the 
desired  motion  or  task  to  be  implemented  with  the  platform: 

6 

Wcouple=  £  f([s  3,  0212,  a  12,  E,  E,  D,  D,  bl,  L,  Me,  Md  My,  le".  Id",  Ib"Ji) 

The  actuator  requirements  (forces,  power  and  frequency  response)  are  a  function  of  the 
coupling  wrench  and  therefore  a  function  of  the  geometry,  the  system  parameters  such  as 
masses  and  spring  constants,  and  the  desired  motion  or  task. 

The  test  results  will  help  to  gain  some  understanding  of  the  dynamic  behavior  of  the 
system.  Since  the  equations  of  motion  are  a  function  of  so  many  different  parameters,  it  is 
very  difficult  to  asses  the  effect  of  all  the  possible  parameter  variations.  This  is  why  only 
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some  combinations  will  be  tested,  enough  to  understand  the  dynamics  of  the  system  and 
help  identify  some  relevant  factors  affecting  such  behavior. 

TTie  second  objective  is  to  demonstrate  the  usefulness  of  this  software  as  integral  part  of 
a  CAE  tool  for  the  design  of  parallel  manipulators  as  mentioned  in  Section  1.4.  By 
evaluating  the  effect  of  different  parameters  on  the  dynamic  behavior  of  the  system,  this 
software  will  assist  the  designer  in  the  process  of  developing  a  parallel  manipulator. 

7.1  System  Geometrical  Description 

The  system  geometry  is  determined  by  the  location  of  the  connector  base  and  end 
points,  which  are  a  function  of  the  platform  and  base  dimensions,  and  the  reference 
location  of  the  platform  with  respect  to  the  base  as  mentioned  in  Section  3.3.  The 
connector  base  point  B  is  the  point  at  which  the  connector  and  the  base  are  joined  together 
by  a  Hooke  joint.  The  connector  end  point  P  is  the  the  point  at  which  the  connector  and  the 
*  platform  are  joined  together  by  a  spherical  joint. 

The  geometry  of  the  base  and  platform  can  be  described  in  different  ways  [9, 10, 1 1] 
such  as  the  one  shown  in  Figure  7.1  which  describes  a  general  six-six  platform.  The 
designation  six-six  indicates  that  each  base  point  is  at  different  location,  and  each  end  point 
is  at  different  location  (no  common  points).  All  the  base  points  are  on  a  circle  of  radius  r  b. 


Be 


Bs 


P6 


P5 


Bi 


Figure  7.1  -  Base  and  Platform  Geometry 
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B6 


Bi 


B3 


B4 


Figure  7.2  -  Orientation  of  the  platform  with  respect  to  the  base 


The  location  of  each  base  point  is  determined  by  the  radius  r  b  and  the  angle  9  as  shown  in 
Figure  7. 1 .  A  similar  arrangement  is  used  for  each  end  point  position  on  the  platform.  In 
the  case  of  the  platform,  the  radius  r  p  and  the  angle  <{)  are  used.  The  location  of  the 

platform  with  respect  to  the  base  is  specified  by  the  angle  p  as  shown  in  Figure  7.2. 

The  geometry  used  for  testing  the  dynamic  simulation  algorithm  is  shown  in  Figure  7.3. 
This  geometry  has  been  proposed  by  [2, 16]  and  its  simplifies  the  forward  kinematic 
analysis  considerably.  All  the  base  and  end  points  are  located  on  the  sides  or  vertices  of 
equilateral  triangles.  The  geometry  is  determined  by  the  dimension  called  SIDE  and  the 
scaling  factors  BSIDE,  TSCALE  and  TSIDESCALE  as  shown  in  Figure  7.4.  The 
connecting  arrangement  is  shown  in  Figure  7.5.  The  reference  or  home  position  of  the 
platform  with  respect  to  the  base  is  determined  by  locating  the  platform  parallel  to  the  base. 
The  centerpoint  of  the  platform  is  at  a  distance  H  along  the  Z  axis  as  shown  in  Figure  7.6. 
This  distance  is  a  function  of  SIDE  and  the  scaling  factor  HSCALE.  The  following  values 
for  SIDE  and  the  scaling  factor  are  used  for  all  the  simulation  test  cases:  SIDE  =  4  ft , 
BSCALE  =  1.05,  TSIDESCALE  =  0.625  and  TSCALE  =  0.55.  The  geometry  of  the 
system  wUl  be  varied  by  changing  the  reference  position  using  the  scaling  factor  HSCALE. 


Platform 

P5 


Figure  7.3  -  Manipulator  Geometry  used  for  testing 


BASE  DIMENSIONS 


PLATFORM  DIMENSIONS 


^SIDE  *  TSIDESCALE-»J 
INSIDE  *TSCALE-^| 


-SIDE- 

 SIDE*  BSCALE- 


Figure  7.4  -  Base  and  platform  geometry  used  for  testing 


Figure  7.6  - 


Platform  reference  position 
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In  general  all  the  base  points  are  constrained  to  be  in  the  same  plane.  An  interesting 
possibility  is  to  locate  the  base  points  on  different  planes  as  shown  in  Figure  7.7.  In  this 
particular  arrangement,  three  base  points  are  in  one  plane  and  the  remaining  three  base 
points  are  in  another  plane.  For  the  test  cases  three  of  the  base  points  will  be  in  one  plane, 
the  other  three  will  be  in  parallel  plane  at  a  distance  b  as  shown  in  Figure  7.8.  The  location 
of  the  base  points  will  be  similar  to  the  geometry  used  for  when  all  the  points  are  coplanar 
as  shown  in  Figure  7.8. 

In  summary,  the  geometric  variations  that  will  be  used  for  the  testing  of  the  software 
are  changes  of  the  platform  reference  height  H  and  changes  in  the  distance  between  base 
point  planes,  b.  The  change  of  the  values  H  and  b  will  change  the  connector  line 
coordinates  s  3  and  the  connector  unit  vectors  s  2  and  s  23  as  mentioned  in  Section  3.3. 
This  affects  the  actuator  requirements  since  many  of  the  terms  of  the  equations  of  motion 
are  functions  of  these  unit  vectors.  These  variations  are  by  no  means  the  only  possible 
geometric  variations,  there  are  infinite  combinations  of  geometric  variations  that  can  be 
used.  These  tests  are  conducted  to  understand  some  of  the  relationships  between  the 
geometric  parameters  and  the  dynamic  behavior  of  the  system. 

7.2  System  Parameters 

As  mentioned  previously,  the  system  parameters  include  the  masses  and  the  moment  of 
inertia  of  the  platform  and  the  connector  rigid  bodies;  the  spring  constants  of  the  coupling 
stage,  the  decoupling  stage  and  the  connector  itself;  and  the  damping  coefficients  of  the 
coupling  and  decoupling  stages  (see  Chapter  2).  As  in  the  case  of  the  manipulator 
geometry  there  are  an  infinite  number  of  combinations  of  these  parameters  that  can  be  used 
for  testing  the  dynamic  simulation  algorithm,  but  such  wide  range  of  tests  is  beyond  the 
scope  of  this  project.  The  purpose  here  is  to  vary  some  of  the  system  parameters  in  order 
to  understand  their  effects  on  the  actuator  requirements.  , 


Figure  7.8 


Location  of  base  points  in  two  parallel  planes 
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7.2.1  Inertial  Parameters 

The  platform  mass  and  moment  of  inertia  are  determined  by  modeling  the  platform  as  a 
thin  disk  made  out  of  aluminum  with  a  radius  of  1.5  ft  and  0.5  inches  thick.  These 
dimensions  are  in  proportion  with  the  dimensions  of  the  base  and  platform  selected.  Using 
this  information,  the  inertial  parameters  of  tiie  platform  are 

Mp  =  50  lbs;  Ipzz=301bf-ft2;  Ip^x  =  Ipyy  =  601bf-ft2 

The  inertial  parameters  for  the  actuator  and  the  decoupling  stage  damper  present  more 
of  a  challenge  to  determine.  The  main  reason  is  that  these  parameters  depend  on  the 
actuator  dimensions  and  requirements  which  in  turn  depend  on  the  results  of  the  dynamic 
simulation.  This  problem  will  be  circumvented  by  making  a  conservative  assumption.  The 
decoupling  damper  will  be  assumed  to  be  solid  steel  cylinder  of  2.5  inches  in  diameter  and 
8  inches  long.  The  actuator  moving  mass  and  fixed  mass  will  be  assumed  to  be  a  solid 
steel  cylinder  of  2.5  inches  in  diameter  and  4  inches  long.  Using  these  assumptions,  the 
inertial  paramet^s  for  these  elements  are 

Me  =  Mb  =  7.5  lbs;  Ibzz=  Iezz=  1  Ibf  -  ft^;  Ib„  =  lexx  =  Icyy  =  2  Ibf  -  ft^ 
Md  =  151bs;  Idzz  =  21bf-ft2;  Id^x  =  Wyy  =  4  Ibf -  ft^ 

One  of  the  objectives  of  using  such  conservative  estimates  is  to  obtain  the  worst  case 
actuator  requirements. 

■  '        i  ' 

7.2.2  Spring  Constants  and  Damping  Coefficients 

The  type  of  tasks  used  for  the  simulation  tests  do  not  involve  high  frequaicy 
disturbances  (see  Section  2.5 ),  therefore  the  decoupling  stage  will  be  deactivated.  The 
values  used  for  the  spring  constant  and  the  damping  coefficient  of  decoupling  stage  are 


ft  -  sec 
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Since  the  decoupling  stage  is  deactivated,  the  decoupling  stage  mass  does  not  change  its 
displacement  D  along  the  direction  s  3.  The  decoupling  stage  is  located  at  1.25  ft  ftom  the 

base  of  the  connector  which  is  enough  to  accommodate  the  height,  base  and  platform 
dimensions. 

The  tasks  used  for  testing  do  not  require  implicit  force  control,  therefore  the  coupling 
stage  is  also  deactivated  (see  Section  2.5).  The  connector  will  also  be  assumed  to  be 
infinitely  rigid  and  the  transmission  will  assumed  to  be  fiictionless.  The  reason  for 
neglecting  the  actuator/transmission  friction  is  that  upon  furthCT  examination  and  some 
initial  results  of  the  dynamic  simulation,  it  was  determined  that  the  actuator  model  to  be 
incomplete.  The  main  reason  being  that  most  actuators  are  not  back  drivable  or  present 
very  high  resistance  to  externally  imposed  motions  (specifically  the  hydraulic  actuators). 
More  descriptive  actuator  models  should  be  considered  in  future  work. 

The  net  effect  of  deactivating  the  coupling  stage  and  making  the  connector  extremely 
stiff  is  that  the  velocity  and  acceleration  of  the  actuator  will  be  the  same  as  the  V  3  and  A  3 
terms  derived  in  Sections  3.4  and  3.5  respectively.  The  displacement  E  is  then  given  by 

E=L-lio 

where  1  lo  is  the  free  length  of  K  l,  which  is  in  this  case  is  assumed  to  be  1 .25  ft  long. 

7.3  Motion  and  Task  Planning  for  Testing 

Two  different  types  of  motions  or  tasks  are  used  for  testing  the  dynamic  simulation 
software.  The  platform  will  be  used  in  a  machining  process  to  support  and  move  a  150  lb 
workpiece.  A  full  groove  will  be  cut  with  a  four  tooth  end  mill  as  explained  in  Section 
4.1.2.  The  cutting  force  is  assumed  to  be  200  Ibf  and  the  workpiece  is  to  be  taken  through 
rectilinear  and  curvilinear  motions  as  explained  in  Chapter  3,  section  3.6. 


7.3.1  Rectilinear  Motion 

The  first  motion  to  be  used  for  machining  the  workpiece  is  a  rectilinear  motion  parallel 
to  the  XY  plane  at  a  distance  H  ft-om  the  base  as  shown  in  Figure  7.9,  along  the  axis  of 

translation  w  which  is  at  an  angle  6  with  the  X  axis  as  shown  in  Figure  7. 10.  The 
platform  starts  moving  from  point  C  o,  moves  a  distance  of  AS  along  the  direction  of 
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Figure  7. 10  -  Axis  of  Translation  for  the  Platform 
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 1  1  ►  Y 

Figure  7.  II  -  Curvilinear  Motion  for  Machining 

motion  in  a  period  of  time  T  and  completes  its  motion  at  point  C  f.  The  workpiece  will  be 
machined  throughout  the  complete  motion. 

7.3.2  Curvilinear  Motion 

The  second  motion  to  be  used  for  machining  the  workpiece  is  a  curvilinear  motion  in 
the  YZ  plane.  TTie  radius  of  curvature  r  c  is  0.5  ft,  the  axis  of  rotation  s  is  parallel  to  the  X 
axis  and  intersects  the  Z  axis  at  a  distance  H  +  r  c  from  the  base  as  shown  in  Figure  7.11. 
The  initial  orientation  of  the  platform  is  -  90°,  and  it  rotates  180°  in  a  period  of  time  T  to 
end  at  a  orientation  of  +  90°.  The  workpiece  will  be  machined  throughout  the  complete 
motion  and  the  cutting  forces  are  tangent  to  the  path  at  all  times. 

7.4  Test  Cases.  Results  and  Discussion 
As  mentioned  before,  there  are  many  combinations  of  parameters  that  can  be  used  when 
testing  the  dynamic  simulation  software.  One  of  the  objectives  of  the  testing  is  to  gain 
some  insight  of  the  dynamic  behavior  of  the  platform,  not  to  test  as  many  combinations  of 
parameters  as  possible.  The  effect  of  geometric  variations  will  be  explored  by  changing  the 
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height  H  and  the  distance  b  as  discussed  in  section  7.1.  The  effect  of  variations  in  the 
system  parameters  will  be  evaluated  by  increasing  the  mass  and  moment  of  inertia  of  the 
connector  rigid  bodies.  The  effects  of  variations  of  the  motion  planning  parametCTS  will  be 
examined  by  reducing  the  time  period  T  required  for  completing  the  motion,  and  by 
changing  the  type  of  motion  (rectilinear  and  curvilinear)  used 

The  required  actuator  forces  will  be  calculated  for  each  test  by  the  simulation  program 
and  displayed.  One  important  condition  is  that  the  actuator  force  requirements  must  not 
exceed  the  maximum  force  capacity.  When  this  happens,  the  system  is  operating  in  an 
condition  known  as  an  actuator  singularity  and  the  desired  motion  cannot  be  produced  by 
the  manipulator.  The  possibility  of  this  condition  happening  wiU  be  monitored  using  the 

actuator  force  index  X  which  is  determined  by 


where  F  max  is  the  maximum  force  capacity  of  the  actuators  and  F  is  the  required  actuator 

force.  The  above  equation  is  similar  to  the  definition  of  some  performance  indices  used  in 

the  area  of  control  theory  [29].  The  use  of  the  force  index  X  allows  all  the  actuators  of  the 

manipulator  to  be  compared  on  the  same  dimensionless  scale  which  might  be  somewhat 
difficult  by  just  using  the  actuator  force  plots.  The  force  index  simplifies  identifying 
actuator  saturation;  the  smaller  the  force  index,  the  closer  the  actuator  is  to  being  saturated. 
This  index  also  allows  the  designer  to  avoid  overdesigning  or  underdesigning  when 
selecting  the  actuators. 

The  determinant  of  the  Manipulator  Jacobian  [  J  m  ]  is  also  an  indicator  of  possible 

actuates-  saturation.  When  the  determinant  is  zero,  the  actuators  cannot  generate  the  desired 
motion  as  discussed  in  Section  4.5  and  will  saturate.  As  the  determinant  increases  in 
magnitude  the  less  likely  the  actuators  will  saturate  in  general.  Since  the  determinant  has 
units  of  length  ^  ,  it  will  be  divided  by  the  maximum  value  of  the  determinant  to  eUminate 
the  units.  Therefore  it  will  become  a  dimensionless  indicator  of  actuator  saturation  for  the 
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complete  manipulator.  This  will  be  a  combined  inidicator  of  the  effectiveness  of  all  the 
actuators  of  the  manipulator.  This  simplifies  the  task  of  comparing  manipulator  designs. 

7.4.1  Test  Cases  with  Geometric  Variations 

The  first  test  cases  involve  a  rectilinear  motion  of  the  platform  as  discussed  in  section 
7.3-1.  In  the  first  group  of  tests  the  height  of  the  platform  was  increased  ft-om  1  ft  to  5  ft, 
the  distance  b  is  zero  and  the  time  period  T  is  30  seconds.  The  results  of  these  tests  are 
shown  in  Figure  7.12. 

For  the  rectilinear  motion  it  can  be  seen  that  as  the  height  is  increased  there  is  a  increase 
in  the  force  requirements  for  most  of  the  actuators,  although  actuators  5  and  6  show  a 
reduction  in  force  requirements.  This  is  seen  more  clearly  in  the  force  index  plots.  This 
suggests  that  the  general  force  requirements  increase  with  the  height.  The  lower  the  height, 
the  greater  the  s  3x  and  s  3y  components  of  each  connector  as  shown  in  Figure  7. 1 3.  This 
means  that  the  horizontal  force  components  are  greater  which  are  desirable  for  balancing  the 
effect  of  a  horizontal  external  load,  such  as  the  cutting  force.  The  disadvantage  is  that  the 
connectors  will  be  closer  to  a  configuration  where  will  be  partially  working  against  other 
connectors.  The  extreme  case  is  when  the  height  is  close  to  zero.  When  two  connectors 
are  totally  opposite  to  each  other,  one  of  them  is  redundant. 

As  the  height  increases,  the  connectors  will  have  greater  vertical  force  components  as 
shown  in  Figure  7.14  and  the  possibility  of  having  opposite  connectors  is  virtually 
eliminated.  The  disadvantage  is  that  when  the  connectors  have  large  vertical  components 
the  platform  will  be  become  very  weak  in  the  horizontal  plane  and  very  large  actuator  forces 
are  required  to  balance  an  external  horizontal  load,  such  a  the  cutting  force.  Therefore  the 
platform  height  should  not  be  increased  too  much.  The  effects  of  further  increasing  the 
height  of  the  platform  in  a  rectilinear  motion  are  shown  in  figure  7. 15.  It  can  be  seen  that 
the  actuator  requirements  increase  as  the  height  is  increased.  The  definition  of  a  what  is 
considered  a  low  or  high  platform  depends  on  the  other  factors  such  as  the  type  of  motion 
and  the  type  of  external  loads  applied. 
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Figure  7. 12a  -  Effects  of  platform  height  on  the  actuator  forces,  rectilinear  motion 


9: 


160 


Actuator  1 


Actuator  2 


100 
75 

X  50 

25 


-12       -6  0  6  12 

displacement,  inches 
Actuator  3 


100 
75 

A  50 
25 


-12       -6  0  6  12 

displacement,  inches 
Actuator  5 


100 
75 

X  50 
25 
0 


XT  rrriT 

-12       -6  0  6  12 

displacement,  inches 

  H  =  lft 

-+-  H  =  3ft 
 H  =  5ft 


100 
75 
50 
25 


-12      -6  0  6  12 

displacement,  inches 
Actuator  4 


100 

75 
50 
25 


-12       -6  0  6 

displacement,  inches 
Actuator  6 


12 


100 


75 


50 


25 


TTrrnr 

irnnr 

TTiTTI  r 

T  rrrm 

-12       -6  0  6  12 

displacement,  inches 


Figure  7.12b  -  Effects  of  platform  height  on  the  force  index  X,  rectilinear  motion 


Figure  7.14  -  Platform  at  greater  height 
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Figure  7. 15  -  The  effects  of  further  increases  of  the  height  of  the  platform 
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The  second  test  case  uses  the  curvilinear  motion  described  in  section  7.3.2  and  the 
reference  height  of  the  platform  is  increased  from  2  ft  to  4  ft,  the  distance  b  is  zero  and  the 
time  period  T  is  15  seconds.  The  results  of  these  tests  are  shown  in  Figure  7.17. 

The  effects  of  changing  the  height  for  the  curvilinear  motion  are  totally  different  from 
the  results  obtained  for  the  rectilinear  motion.  For  the  curvilinear  motion  as  the  height  is 
increased,  the  overall  force  requirements  are  lowered.  The  improvement  is  more  noticeable 
in  actuators  2  and  3  when  the  platform  is  at  the  initial  orientation  of  -  90°  and  the  final 
orientation  of  +  90°.  The  location  of  the  platform  close  to  the  initial  location  is  shown  in 
Figure  7. 16.  In  this  orientation  the  cutting  force  and  the  weight  of  the  platform  are  pushing 
the  platform  downwards.  The  greater  height  makes  the  connector  vertical  components 
greater,  which  can  then  balance  out  the  external  and  gravitational  loads  more  effectively. 


Figure  7.16  -  Platform  close  to  the  initial  position  for  the  curvilinear  motion 
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Figure  7.17a  -  Effects  of  the  platform  height  on  the  actuator  forces,  curvilinear  motion 
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Figure  7. 17b  -  Effects  of  the  platform  height  on  the  force  index  X,  curvilinear  motion 
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The  next  set  of  tests  consist  of  changing  the  distance  b  (as  shown  in  figure  7. 18)  while 
keeping  the  platform  at  a  fixed  height  of  2  ft  and  the  time  period  T  equal  to  30  seconds. 
The  results  of  the  rectilinear  and  curvilinear  motions  are  shown  in  Figures  7. 19  and  7.20 
respectively. 

These  plots  indicate  that  the  greater  the  distance  b  between  the  planes,  the  greater  the 
genwal  actuator  force  requirements.  The  increase  of  the  distance  b  increases  the  horizontal 
force  components  for  the  connectors  in  the  higher  plane.  This  allows  the  platform  to 
balance  the  horizontal  load  with  less  force,  but  at  the  same  time  it  locates  the  connectors  in  a 
configuration  where  they  are  partially  working  against  each  other.  The  extreme  case  is 
when  the  distance  b  is  equal  to  the  height  H.  In  this  case  the  three  connectors  are 
completely  horizontal  and  will  be  balancing  the  external  load  and  partially  working  against 
each  other.  The  force  indices  change  with  the  type  of  motion.  For  the  rectilinear  motion 
the  actuators  2, 4  and  6,  which  are  not  relocated  by  the  factor  b,  have  lower  indices.  For 
the  curvilinear  motion  the  actuators  1,  3  and  5,  which  are  relocated  by  the  factor  b,  have 


Figure  7.18  -  Platform  with  base  points  in  two  parallel  planes 
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lower  indices.  This  illustrates  the  fact  that  a  much  greater  number  of  tests  is  required  in 
order  to  better  understand  the  effects  of  geometric  variations.  The  main  reason  for  such 
behavior  is  the  complex  relationship  between  the  connector  forces  (and  actuator  forces),  the 
line  coordinates  and  the  geometry  of  the  system  which  can  be  observed  in  the  equations  of 
motion 

6 

I  (Fi  §3)1  =  Wext  +  Wp  +  Wgr  +  Wtan  +  Wcor  +  Wcent 
1  =  1 

where  the  line  coordinates  are  given  by 

The  direction  s  3  is  a  function  of  the  position  of  the  base  points  and  the  end  points  as 
mentioned  in  Section  3.3.  The  relative  position  vector  Rpc  is  a  function  of  the  dimensions 
and  the  orientation  of  the  platform.  Therefore  since  the  vectors  s  3  and  R  pc  are  functions 
of  so  many  parameters,  it  is  difficult  to  determine  the  effect  on  one  parameter  on  the 
behavior  of  the  system.  The  great  amount  of  combinations  of  geometric  parameters  makes 
difficult  to  generalize  the  above  observations.  This  is  problem  is  further  compounded  by 
other  factors  such  as  the  type  of  external  loads 


Actuator  1 


Actuator  2 


500 
250 

Ibf  0 

-250 
-500 


-12       -6  0  6  12 

displacement,  inches 
Actuator  3 


500 


-500 


-12       -6  0  6  12 

displacement,  inches 


500 


250 


-250 


-500 


-12       -6  0  6  12 

displacement,  inches 
Actuator  4 


500 

250 
0 

-250 
-500 


-12       -6  0  6  12 

displacement,  inches 


Actuator  5 


Actuator  6 


500 
250 
Ibf  0 
-250 
-500 


1 1 1  It  1 1 

-H-H-m- 

1  1  1  1  1  1  I- 

1 1 1 II 1 1 

-12-6  0  6 

displacement,  inches 

  b  =  0.5ft 

b=lft 
 b  =  2ft 


12 


500 


250 


-250 


-500 


 II 

1  1  1  1 1 N- 

-t-H  II  1  1 

•1  1  1  II  1  1 

-12       -6  0  6  12 

displacement,  inches 


Figure  7.19a  -  Effects  of  the  distance  b  on  the  actuator  forces,  rectilinear  motion 
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Figure  7.19b  -  Effects  of  the  distance  b  on  the  force  index  X,  rectilinear  motion 
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Figure  7.20a  -  Effects  of  the  distance  b  on  the  actuator  requirements,  curvilinear  motion 
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Figure  7.20b  -  Effects  of  the  distance  b  on  the  force  index  X,  curvilinear  motion 
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7.4.2  Test  Cases  with  Variations  of  the  Direction  of  Motion 

The  effects  of  changing  the  axis  of  tianslation  w  for  the  rectilinear  motion  are  shown  in 
Figure  7.21  and  7.22.  This  axis  is  determined  by  the  value  of  the  angle  6  as  shown  in 

Figure  7.10.  The  values  used  are  0  =  0°  (the  X  axis ),  30°,  60°,  90°  ( the  Y  axis ),  120° 

and  150°.  The  height  used  was  2  ft  and  the  time  period  was  set  to  30  seconds.  These 
results  indicate  that  the  forces  requirements  change  as  the  direction  changes  but  no  general 
pattern  is  seen  in  these  results.  Although  no  pattern  can  be  observed  it  is  important  to  use 
different  direction  of  motion  when  designing  a  manipulator  to  establish  the  actuator  force 
requirements. 

As  mentioned  previously,  the  magnitude  of  determinant  of  the  Manipulator  Jacobian 
[  J  m  ]  is  another  way  of  checking  for  actuator  saturation.  It  was  used  here  to  asses  the 
effects  of  changing  the  axis  of  translation  w  for  rectilinear  motions.  The  determinant  is 
calculated  and  shown  in  figure  7.23.  Using  this  as  an  indicator,  the  best  or  most  effective 

directions  of  motion  are  6  is  equal  to  30  °  and  90  °.  This  is  difficult  to  verify  with  the  force 

index  plots  since  some  of  the  indices  improve  at  these  angles  and  others  decrease  as  shown 
in  Figures  7.21  and  7.22.  Based  on  these  results,  it  can  be  said  that  the  determinant  of  the 
[  J  m  ]  may  not  be  an  accurate  indicator  of  the  effectiveness  of  the  actuators. 

One  of  the  possible  reasons  for  the  disparity  in  the  observations  is  that  the  determinant 
is  a  combined  or  composite  indicator  which  takes  into  account  all  the  actuators  while  the 

force  index  X  is  an  indicator  of  the  effectiveness  of  an  individual  actuator.  Another 

important  consideration  is  that  the  determinant  is  used  for  calculating  the  connector  forces 

(Fl)  =[Jm]-M  Wext  +  Wp  +  Wgr  +  Wtan  +  Wcor  +  Wcent) 

Once  the  connector  forces  are  known,  the  actuator  forces  can  be  determined  using  (see 
Section  6.3 ) 

Fa=FL  +  Me[E+gS3^-E(to]{l-(s3xl)2)  +  coi)]  +  C,E+  Cd(D-iJ) 
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It  is  clear  that  the  actuator,  in  addition  to  producing  the  connector  force  F  l  ,  has  to 
accelerate  the  mass  M  e  and  work  against  the  decoupUng  damper  and  the  internal  friction  of 
the  actuator.  Therefore  its  is  possible  to  have  actuator  saturation  even  if  the  connector  force 
F  L  is  considerably  low.  The  determinant  is  not  capable  of  predicting  such  situations. 

The  advantage  of  using  the  determinant  is  that  it  is  a  single  index  that  groups  all  the 
actuators  together.  This  simpUfies  the  evaluation  of  the  manipulator  considerably  when 
compared  to  the  use  of  the  individual  forces  indices.  More  research  is  required  in  order  to 
correlate  the  value  of  the  determinant  and  the  effectiveness  of  the  actuators. 
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Figure  7.21a  -  Effects  of  the  axis  of  translation  w  on  the  actuator  forces,  6  =  0°,  30° 
and  60°,  rectilinear  motion 
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Figure  7.21b  -  Effects  of  the  axis  of  translation  w  on  the  force  index  X,  6  =  0°,  30°  and 
60°,  rectilinear  motion 
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Figure  7.22a  -  Effects  of  the  axis  of  translation  w  on  the  actuator  forces,  6  =  90°,  120° 
and  1 50°,  rectilinear  motion 
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Figure  7.22b  -  Effects  of  the  axis  of  translation  w  on  the  force  index  A,  0  =  90°,  120° 
and  1 50°,  rectilinear  motion 
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Figure  7.23  -  The  determinant  of  [  J  m  ]  for  the  rectilinear  motion  in  different  directions 
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7.4.3  Variations  in  the  Time  Period 

The  fourth  set  of  tests  were  conducted  using  variations  of  the  time  period  T.  The 
shorter  the  time  period,  the  faster  the  platform  moves.  The  results  of  the  tests  for  the 
rectilinear  and  curvilinear  motions  are  shown  in  Figure  7.24  and  7.25  respectively.  It  can 
be  seen  that  the  reduction  of  the  time  period  form  30  seconds  to  5  seconds  does  not 
produce  any  noticeable  changes  in  the  force  requirements.  The  reduction  to  a  time  period 
of  1  second  produces  some  changes  of  the  force  requirements,  although  not  the  dramatic 
changes  expected  from  a  reduction  by  a  factor  of  30  of  the  time  period. 

The  platform  moves  faster  as  the  time  period  used  is  shorter,  and  the  velocity  and 
acceleration  of  the  connectors  will  increase.  This  will  increase  the  magnitude  of  the 
tangential,  Coriolis  and  centrifugal  coupling  wrenches  of  the  connectors  since  they  are 
functions  of  the  kinematic  state  of  the  system  among  other  things  (see  Section  5.6 ) 

^        ^        ^  6 

Wtan  + Wcor+ Wcent  =  £  f([  W  12,  Ot  12,  E,  D,  ...  ji) 

i 

Since  these  wrenches  are  a  function  of  the  kinematic  state,  one  would  expect  a 
noticeable  increase  in  the  actuator  force  requirements  as  the  platform  moves  faster.  This 
trend  is  not  observed  in  the  test  results.  One  possible  explanation  is  that  the  magnitudes  of 
the  angular  velocities  and  acceleration  vectors  are  small  for  the  motions  tested  These 
values  are  shown  for  the  curvilinear  motion  in  Figures  7.26  and  7.27.  It  can  be  noticed 
that  for  the  time  periods  of  15  and  5  seconds  the  angular  velocities  and  accelerations  are 
less  than  1  rad/sec  and  1  rad/sec  2  respectively.  It  is  only  for  a  time  period  of  1  second  that 
these  values  become  somewhat  significant.  Note  that  these  are  the  magnitudes  and  the 
signs  are  not  included.  The  sign  of  the  angular  velocities  and  accelerations  determined  the 
signs  of  some  of  the  terms  in  the  coupling  wrench.  Therefore  the  effect  of  an  increase  of 
one  angular  acceleration  might  be  canceled  by  the  decrease  of  another  angular  acceleration. 

Another  factor  to  take  into  account  how  the  values  for  the  time  periods  and 
displacements  for  actual  applications  compare  to  the  values  used  for  testing.  The  time 
period  of  1  second  means  that  the  platform  is  moving  a  average  rate  of  1200  in  /  min  which 
is  higher  than  the  feed  rates  possible  with  existing  technology  (<  1000  in  /  min)  [25]. 
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Figure  7.24a  -  Effects  of  the  time  period  on  the  actuator  forces,  rectilinear  motion 
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Figure  7.24b  -  Effects  of  the  time  period  on  the  force  index  X,  rectilinear  motion 
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Figure  7.25a  -  Effects  of  the  time  period  on  the  actuator  forces,  curvilinear  motion 
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Figure  7.25b  -  Effects  of  the  time  period  on  the  force  index  X,  curvilinear  motion 
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Figure  7.26  -  Connector  Angular  Velocities  as  a  function  of  the  time  period  T 
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Figure  7.27  -  Connector  Angular  Accelerations  as  a  function  of  the  time  period  T 
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7.4.4  Test  Cases  with  Variations  of  Inertial  Properties 

The  effects  of  the  connector  masses  and  moments  of  inertia  on  the  dynamic  behavior  of 
is  explored  in  the  last  set  of  tests.  The  platform  height  is  set  to  2  ft,  the  distance  b  is  zero 
and  the  time  period  is  30  seconds.  The  masses  and  inertias  are  multiplied  by  a  factor  of  1, 
3  and  5  ( indicated  by  the  notation  M  x  1,  M  x  3  and  M  x  5 ).  The  results  of  the  rectilinear 
and  curvilinear  motions  are  shown  in  Figures  7.28  and  7.29  respectively. 

It  can  be  seen  that  as  the  inertial  properties  are  increased,  the  general  actuator  force 
requirements  increase.  The  greatest  increases  are  seen  for  the  actuators  2, 3, 5  and  6  where 
the  force  requirements  register  more  than  a  100%  increase.  This  suggests  that  the  inertial 
parameters  have  a  significant  effect  on  the  dynamic  behavior  of  the  system.  All  the 
coupling  terms  in  the  equations  of  motion  are  functions  of  these  inatial  parameters  as 
shown  in  Section  5.6.  Since  for  the  motions  used  for  testing  generate  small  values  for  the 
connector  angular  velocity  and  acceleration  vectors,  the  only  numerically  significant 
coupling  term  left  is  the  gravitational  wrench.  This  term  is  a  function  of  the  gravitational 
acceleration  and  the  geometry  of  the  system.  These  results  indicate  that  the  gravitational 
terms  are  relevant  in  the  dynamic  behavior  of  the  system  regardless  of  the  speed  of  the 
platform  and  should  be  considered  when  designing  and  controlling  a  parallel  manipulator. 

Once  more  these  observations  are  based  on  some  simple  test  cases,  and  in  order  to 
study  general  trends  much  more  testing  is  required.  If  the  gravitational  coupling  is  found  to 
a  sole  significant  coupling  factor,  the  manipulator  can  be  designed  to  reduce  this  effect 
through  mass  balancing. 

7.5  Summary 

These  observations  are  base  on  a  small  group  of  tests.  The  equations  of  motion  are 
functions  of  a  great  set  of  factors  (  see  Section  5.6 )  that  can  be  changed.  This  underlines 
the  great  importance  of  more  testing  with  different  sets  of  geometric  parameters,  system 
parameters,  motions  and  tasks  in  order  to  carefully  study  the  effects  of  coupling. 

These  results  provide  some  insight  to  the  dynamic  behavior  of  a  platform  system  and 
how  its  is  affected  by  different  factors.  Much  more  testing  is  required  using  different 


combinations  of  parameters.  One  of  the  useful  aspects  of  these  results  is  that  it  gives  the 
researcher  some  idea  of  the  parameters  that  should  be  changed  and  analyzed  such  as  the 
connector  masses  and  the  relocation  of  the  base  points. 
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Figure  7.28a  - 


Effects  of  the  mass  and  inertial  parameters  on  the  actuator  forces, 
rectilinear  motion 
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Figure  7.28b  -  Effects  of  the  mass  and  inertial  parameters  on  the  force  index  X, 
rectilinear  motion 
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Figure  7.29a  -  Effects  of  the  mass  and  inertial  parameters  on  the  actuator  forces, 
curvilinear  motion 
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Figure  7.29b  -  Effects  of  the  mass  and  inertial  parameters  on  the  force  index  X, 
curvilinear  motion 


CHAPTER  8 
CONCLUSIONS  AND  RECOMMENDATIONS 


Although  more  work  is  needed  in  the  area  of  dynamics  of  parallel  manipulator,  many 
useful  observations  and  recommendations  have  been  obtained  from  this  research  which 
constitutes  a  major  step  towards  the  development  of  the  Computer  Assisted  Engineeing 
tool  for  the  design  and  analysis  of  parallel  manipulators. 

8.1  Developing  the  Dynamic  Model 
The  expUcit  equations  of  motion  for  the  parallel  manipulator  have  been  determined  and 
used  for  developing  a  computer  simulation  of  the  dynamic  behavior. 

8. 1 . 1  Selection  of  a  Formulation  Method 

In  this  research  Kane's  Method  has  been  successfully  applied  in  the  development  of  the 
explicit  equations  of  motion  for  a  parallel  manipulator.  The  usefuhiess  of  a  given 
formulation  method  seems  to  be  related  to  the  type  of  kinematic  chain  upon  which  the 
manipulator  is  based  on.  Lagrange's  Method  has  been  used  successfully  for  the  modeling 
serial  manipulators,  while  not  so  for  parallel  manipulators. 

Both  the  Newton-Euler  formulation  and  Kane's  Method  require  explicit  force  and 
torque  expressions.  These  are  obtained  from  free-body  diagrams  of  each  of  the  rigid 
bodies  of  the  system.  For  serial  manipulators,  the  force  and  torque  expressions  can  prove 
to  be  difficult  to  obtain  [7, 8, 9, 10].  Since  the  links  or  rigid  bodies  are  in  series,  the 
forces  and  torques  are  not  a  simple  sum  of  the  individual  joint  contributions.  On  the  otho" 
hand,  the  force  and  torque  analysis  is  relatively  simple  for  parallel  manipulators.  For  the 
parallel  manipulators,  the  end  effector  force  and  torque  is  produced  by  all  the  connectors 
working  together. 
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The  Lagrange  formulation,  which  does  not  need  a  force  and  torque  analysis  of  the 
system,  requires  explicit  expressions  for  the  velocity  and  position  of  each  joint.  These 
expressions,  which  must  be  in  terms  of  the  system  generalized  coordinates,  are  used  for  the 
kinetic  and  potential  energy  expressions.  For  serial  manipulators  they  are  simple  to  obtain 
since  the  motion  of  the  links  is  additive  [13, 14, 31].  On  the  other  hand,  the  expressions 
for  a  parallel  manipulator,  as  shown  in  Sections  3.4  and  3.5,  are  very  complicated.  This 
quickly  complicates  the  derivation  of  the  dynamic  model  as  outiined  in  Section  5.1.  This  is 
the  main  reason  that  the  explicit  equations  of  motion  for  parallel  manipulators  have  not  beai 
derived  using  Lagrange's  formulation  which  appears  to  be  virtually  impossible  [8, 9]. 

Therefore  the  selection  of  the  method  is  more  than  a  choice  of  the  analyst,  it  is  greatly 
influenced  by  the  type  of  kinematic  chain  used  in  the  manipulator.  For  serial  manipulators 
where  the  force  and  torque  expression  can  become  somewhat  elaborate  but  the  velocity  and 
position  expression  are  relative  simple  to  obtain,  Lagrange's  formulation  is  better.  For 
parallel  manipulators,  where  the  force  analysis  is  relatively  simple  compared  to  the  position 
and  velocity  analysis,  Kane's  Method  works  better. 

8.1.2  Use  of  the  Explicit  Dynamic  Model 

The  dynamic  model  or  equations  of  motion  of  a  manipulator  can  be  used  for  the 
forward  and  inverse  dynamic  analysis.  Some  understanding  of  the  dynamic  behavior  can 
be  gained  by  using  a  computer  simulation  based  on  this  model.  This  can  be  achieved 
regardless  if  the  explicit  equations  of  motion  are  available.  The  great  advantage  of  having 
the  explicit  dynamic  model  is  that  general  observations  can  be  made  without  having  to  run  a 
great  number  of  numerical  simulations. 

The  coupling  between  the  connectors  is  a  good  example  of  the  usefulness  of  the  explicit 
equations  of  motion.  This  coupling  is  quoted  as  being  negligible  or  that  it  can  be  corrected 
using  adaptive  control  systems  [10, 1 1].  It  may  well  be  that  the  combination  of 
manipulator  parameters  and  motions  used  did  not  cause  serious  coupling  effects  [10, 11]. 
On  the  contrary,  the  dynamic  model  derived  in  Chapter  5  indicates  that  for  the  general  case 
there  is  a  high  degree  of  coupling  between  the  connectors  of  the  system.  This  is  caused  by 
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the  gravitational,  tangoitial,  Coriolis  and  centrifugal  accelerations  of  the  connectors.  The 
numerical  simulations  of  Chapter  7  indicate  that  for  the  test  cases  quoted  the  most 
significant  coupUng  is  caused  by  the  gravitational  acceleration.  It  is  conceivable  that  future 
appUcations  will  required  faster  platform  motions  in  which  the  other  coupling  terms  become 
relevant  and  cannot  be  neglected  as  has  been  done  previously  [10, 1 1]. 

The  explicit  equations  of  motion  allow  the  designer  to  select  manipulator  parameters 
that  can  minimize  or  eliminate  the  coupling  effects  of  the  connectors  which  has  thus  far 
been  done  for  serial  manipulators  [13, 14]. 

AnothCT  important  use  of  the  explicit  dynamic  model  is  in  the  design  of  the  control 
system.  The  approach  that  has  been  used  is  to  consider  the  coupUng  effects  as  uncertainties 
or  errors  which  can  be  minimized  using  control  systems  [  10, 1 1  J.  This  may  well  be 
satisfactory  when  the  coupling  effects  are  minimal  but  not  valid  for  fast  motions  with  high 
coupling  effects.  A  more  effective  approach  is  to  use  the  dynamic  model  to  predict  the 
coupUng  effects  and  include  these  effects  in  the  control  commands  to  the  actuators.  This 
will  in  general  create  a  more  precise  system  with  a  faster  time  of  response  [13, 14, 26]. 

8.2  Dynamic  Behavior  of  Parallel  Manipulators 
The  results  of  Chapter  7  provide  some  understanding  of  the  dynamic  behavior  and  how 
its  affected  by  different  variations  of  parameters. 

The  first  observation  that  can  be  made  is  that  the  geometry  has  a  great  effect  on  the 
dynamic  behavior  of  the  manipulator.  Factors  such  as  the  reference  height,  the  axis  of 
translation  and  the  type  of  motion  used  clearly  affect  the  actuator  requirements.  However 
since  there  so  many  parameters  it  is  difficult  to  establish  any  trend  as  shown  in  the  tests  of 
Chapter  7  and  more  testing  with  different  sets  of  parameters  is  recommended. 

As  mentioned  before,  the  explicit  equations  of  motion  indicate  the  high  degree  of 
coupling  between  the  connectors.  However,  the  motions  used  for  testing  did  not  create 
significant  coupUng  effects  except  for  the  gravitational  coupling.  Other  coupling  terms  are 
a  function  of  the  location  and  motion  of  the  platform,  while  the  gravitational  coupling  is 
only  a  function  of  the  location  of  the  platform.  If  this  is  valid  for  great  range  of  tests,  a 


approximate  dynamic  model  can  be  used 


6 

I  (FlSsji  =  Wext  +  ^p  +  Wgr 
i  =  l 

This  approximate  model  would  neglect  all  the  coupling  terms  except  for  the  gravitational 
coupling.  This  approximate  model  could  be  included  in  real  time  control  system  with 
minimal  computational  overhead  since  the  most  time  consuming  terms  to  calculate  are 
omitted.  It  is  important  to  recall  that  this  is  a  useful  approach  only  for  motions  where  the 
other  coupling  terms  are  not  numerically  significant  ( see  Section  6.5 ). 

8.3  Recommendations 

This  research  is  one  of  the  first  steps  towards  the  ultimate  goal  of  developing  a  design  / 
analysis  tool  for  parallel  manipulators.  Much  more  work  must  be  done  before  reaching 
such  goal. 

8.3.1  Dynamic  Modeling 

The  equations  of  motion  of  a  manipulator  can  be  written  in  what  is  known  as  the 
standard  form  in  which  aU  the  displacements,  velocities  and  accelwations  are  written  in 
terms  of  the  generalized  coordinates  and  their  time  derivatives  [13, 14] 

F  =[H(q)]q+qT[C(qi)]q+[K(qi)]q  +  G(qi) 

where  F  is  the  actuator  force  /  torque  vector;  q  =  [  q  i,  q  i ...  ]  T  is  vector  of  the  generalized 

coordinates,  [  H  (q)  ]  is  the  manipulator  equivalent  inertia  tensor,  [  C  (q)  ]  is  the  damping, 
Coriolis  acceleration  and  centrifugal  acceleration  matrix,  [  K  (q)  ]  is  the  stiffness  matrix; 
and  G  (q)  is  the  gravitational  forces  vector.  The  dynamic  behavior  of  a  manipulator  can  be 
understood  better  by  obtaining  the  inertia  tensor  [  H  (q)  ]  [13, 14].  In  order  to  convert  the 
equations  of  motion  derived  in  Chapter  5  to  the  standard  form,  all  the  angular  velocity  and 
acceleration  terms  of  the  connectors  must  be  written  in  texms  of  the  platform  coordinates. 
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velocity  and  acceleration.  This  will  involve  a  considerable  amount  of  work  because  of  the 
length  the  expressions  for  the  angular  velocities  and  accelerations  of  the  connectors  (  see 
Sections  3.4  and  3.5).  Nevertheless  is  may  be  worth  the  effort  since  it  will  possibly 
provide  more  insight  of  the  dynamic  behavior  and  indicate  how  to  simplify  the  dynamics  by 
designing  the  manipulator. 

8.3.2  Testing 

More  testing  is  required  in  order  to  make  general  statements  about  the  dynamic  behavior 
of  parallel  manipulators.  In  order  to  do  so,  more  work  should  be  done  in  the  area  of 
motion  and  task  planning.  Most  of  the  motion  planning  for  manipulators  consist  of  the 
path  planning  of  a  given  point  on  the  end  effector  [13, 32].  This  is  not  sufficient  for 
planning  the  motion  of  a  parallel  manipulator  where  its  orientation  is  also  an  important 
factor.  Therefore  a  mathematical  description  of  actual  tasks  should  be  developed  to  be  used 
as  part  of  the  input  for  the  dynamic  simulation  software. 

A  comparison  of  alternative  platforms  designed  to  perform  the  same  motion  ot  tasks  is 
an  important  issue.  An  actuator  force  index  was  used  to  compare  the  tests  of  Chapter  7 
which  is  essentially  a  dimensionless  performance  index.  This  index  indicates  when  an 
individual  actuator  saturates  but  does  not  indicate  for  how  long  its  saturates  and  does  not 
take  into  account  the  rest  of  the  actuators.  The  designer  has  to  compare  all  the  force  index 
plots  for  one  design  with  all  the  force  index  plots  of  a  competing  design  in  order  to  select 
the  best.  Therefore  there  is  a  need  for  performance  indices  that  can  evaluate  the  combined 
effect  all  of  the  actuators  and  can  be  used  to  quickly  compare  different  designs  in  an 
objective  way.  These  indices  could  use  factors  such  as  power  consumption  and  time  of 
saturation  as  indicators. 
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8.3.3  E)esign 

It  is  highly  desirable  to  simplify  the  equations  of  motion  by  redesigning  the  manipulator 
or  by  using  a  different  motion.  If  more  testing  indicates  that  the  most  significant  coupling 
term  is  the  gravitational  coupling,  then  the  manipulator  can  be  redesigned  to  minimize  it 
The  gravitational  coupling  term,  as  derived  in  Chapter  5,  is  given  by 


i  =  l 


g[MeE+MdD  +  Mbbl]  (      ^  ^  \ 


This  is  caused  by  the  gravitational  acceleration  pulling  the  rigid  bodies  of  the  connector. 
This  term  can  be  reduced  by  using  a  balancing  mass,  m,  at  a  distance  U  below  the  base  of 
the  connector  as  shown  in  Figure  8. 1.  The  gravitational  wrench  can  now  be  writtai  as 


i  =  1 


The  main  problem  is  how  to  select  the  mass  m  and  the  distance  U  to  reduce  or  eliminate  the 
gravitational  coupling.  Fixing  the  mass,  the  distance  U  can  be  calculated  by 


MeE  +  MdD  +  Mbbl 


m 


The  limitation  of  this  equation  is  that  the  displacement  E  and  D  are  not  constant.  In  order  to 
minimize  the  effects  of  the  variations  of  E  and  D,  the  equation  can  be  expressed  in  a 
modified  form 

jj  ^  MeEave  +  MdPave  +  Mfabl 
m 


where  Eave  and  D  ave  are  the  average  values  of  the  displacements  E  and  D. 

One  important  consideration  is  that  the  balancing  mass  can  only  reduced  the  effects  of 
the  gravitational  coupling.  The  use  of  the  balancing  mass  will  increase  the  effects  of  the 


Figure  8.1  -  Connector  with  balancing  mass. 

tangential,  Coriolis  and  centrifugal  accelerations.  Therefore  it  is  important  to  determine  if 
these  coupling  effects  are  minor  before  using  a  balancing  mass. 

8.4  Summary 

The  following  are  the  most  important  findings  and  recommendations  stemming  from  this 
research 

1  -  Kane's  Method  is  an  efficient  method  for  deriving  the  equations  of  motion  for  a  parallel 
manipulator. 


2  -  The  equations  of  motion  indicate  that  there  is  a  high  degree  of  coupling  between  the 

connectors.  This  coupling  is  caused  by  the  gravitational,  tangential,  Coriolis, 
centrifugal  accelerations  acting  upon  the  connectors. 

3  -  The  initial  results  from  the  dynamic  simulations  indicate  that  for  the  test  motions  used 

the  most  significant  coupling  is  caused  by  gravity.  The  magnitude  of  the  connector 
velocity  and  acceleration  vectors  are  relatively  small  for  the  motions  tested. 

4  -  The  explicit  equations  of  motion  are  useful  for  designing  a  manipulator  with  an 

improved  or  simplified  dynamic  behavior.  One  possibility  is  to  use  mass  balancing  to 
minimize  the  effects  of  gravity  of  the  connectors. 


APPENDIX 

KANE'S  METHOD  FOR  DYNAMIC  ANALYSIS 


The  objective  of  this  document  is  to  give  the  reader  a  basic  idea  of  how  Kane's 
Formulation  or  Method  is  used  to  obtain  the  equations  of  motion  of  a  multibody  system.  It 
is  by  no  means  a  complete  description  of  Kane's  method. 

The  equations  of  motion  for  the  dynamic  model  for  a  system  with  "w"  elements  (bodies 
and  particles)  and  "n"  degrees  of  freedom  can  be  obtained  by  using  the  following  equation: 

I  (f^-{rj  (|i.{T,-T-})=0;   k=l,2  „  (1) 

j=l  j  =  l 

This  equation  must  be  setup  for  each  of  the  degrees  of  freedom.  In  order  to  obtain  the 
system's  dynamic  model,  expressions  for  the  following  terms  for  each  body  must  be 
determined: 

,  the  velocity  partial  derivative  of  body  "j"  respect  to  the  kth  generalized  speed 

,  the  angular  velocity  partial  derivative  of  body  "j  "respect  to  the  kth  generalized  speed 

duk 

F  j ,  the  resultant  force  vector  acting  on  body  "j"  at  a  given  point  "c" 

T  j,  the  resultant  torque  vector  acting  on  body  "j",  about  the  point  "c" 

A  j ,  the  acceleration  vector  of  body  "j"  at  a  given  point  "c" 

m  j,  the  mass  of  body  j 

CO  j ,  the  angular  velocity  vector  of  body  "j" 

a  j ,  the  angular  acceleration  vector  of  body  "j" 

Ij" ,  the  inertia  dyadic  of  body  "j",  about  the  point  "c" 

200 


201 

1  Generalized  Coordinate  and  Generalized  Speeds 

A  Generalized  Coordinate  is  a  position  or  displacement  variable  used  to  describe  a 
degree  of  freedom.  The  set  of  Generalized  Coordinates  is  not  unique,  more  than  one  can 
be  used  to  describe  the  configuration  of  a  system.  The  number  of  Generalized  Coordinates 
must  be  equal  to  the  degrees  of  freedom  of  the  system  (n) 

fl  =  ( qi,  q2, ...  qr ,  ...  qn )  =*  set  of  generalized  coordinates 

A  Generalized  Speed  is  a  function  of  the  the  Generalized  Coordinates  and  their  first 
time  derivatives  of  the  Generalized  Coordinates.  The  Generalized  Speeds  are  not  unique, 
more  than  one  set  of  Generalized  Speeds  can  be  used  to  describe  a  system.  The  number  of 
Generalized  Speeds  must  also  be  equal  to  the  degrees  of  freedom  of  the  system  (n) 

u  =  (  u  1,  U2,  ...  Ur,  ...  Un  )  =*  set  of  graieralized  speeds 

The  selection  of  a  given  set  of  Generalized  Speeds  and  coordinates  can  simplify  the 
derivation  of  the  equations  of  motion  of  a  system.  How  to  select  a  set  that  will  simplify  the 
analysis  is  not  immediately  obvious,  it  is  more  a  case  of  experience.  This  is  illustrated  in 
Example  1. 

Example  1  -  Determine  the  degrees  of  freedom,  the  Generalized  Coordinates  and  the 
Generalized  Speeds  for  the  system  shown  in  Figure  1 . 

Solution:  The  system  has  2  degrees  of  freedom.  The  configuration  of  the  system  can  be 
completely  described  once  the  angular  position  of  each  link  is  specified.  Different  sets  of 
Generalized  Coordinates  (each  must  have  two  elements)  can  be  used  to  describe  the 
system,  some  of  them  are 

Set  1  =>  qi  =  X  a  &  q2  =  X  b  ;    Set  2  =>  qi  =  y  a  &  q2  =  y  b 

Set  3  =»  qi  =  0  1  &  q2  =  e  2  ;  Set  4     qi  =  6  i  &  q2  =  0  i  -  6  2 
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Figure  1  -  System  for  Example  1 

Different  sets  of  GenCTalized  Speeds  (each  must  have  two  elements)  can  also  be  used  to 
describe  the  system,  some  of  them  are 


Set  1  =^  u 


dxg 
dt 


&U2  =  -^     ;    Set2-  u,  =  ^  Scn^--^ 


CO  d6 1    n        d0  2         c  .  ^  d0 1    „        d6  2    dO  1 

Set3=>  u,  =  ~L  &U2  =  -^     ;    Set  4  =^  u  ,  = &  u^  = -  ^ 


Any  of  the  above  sets  can  be  used  to  define  the  Generalized  Coordinates  and  the 
Generalized  Speeds  ( for  instance  Set  1  of  the  Generalized  Coordinates  and  set  4  of  the 
Generalized  Speeds  can  be  used ).  Some  of  the  sets  will  make  the  dynamic  modeling  easier 
in  terms  of  the  work  required  to  daive  the  model.  How  to  select  the  optimal  set  of 
Generalized  Coordinates  and  speeds  is  mostly  a  matter  of  experience. 

2  Velocity  Partials  and  Angular  Velocity  Partials 
The  partial  derivative  of  the  velocity  and  the  angular  velocity  are  also  known  as  the 
partial  velocity  and  the  partial  angular  velocity  respectively  [27].  The  use  of  the  terms 
"partial  velocity"  and  "partial  angular  velocity"  is  confusing  since  it  implies  that  these 
quantities  are  velocities  and  they  must  have  velocity  units.  This  is  not  the  case  and  it  is 
easier  to  call  them  the  velocity  partials  and  the  angular  velocity  partials. 
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Expressions  for  the  velocity  at  a  given  point  in  the  body  (the  translational  velocity)  and 
the  angular  velocity  of  each  body  of  the  system  must  be  determined  in  order  to  derive  the 
velocity  and  angular  velocity  partials.  The  velocities  and  angular  velocities  will  be 
expressed  in  terms  of  the  Generalized  Coordinates  and  Generalized  Speeds.  The  velocity 
and  the  angular  velocity  of  a  given  body  can  be  written  as  a  function  of  the  Gaieralized 
Coordinates,  Generalized  Speeds  and  time 

Yi  =  f  (qi,  q2,  ...qn;ui,  U2,  ...Unit)  &  tOi  =  h  (qi,  q2,  ...qn;  Ui,  U2,  ...Unit) 

In  most  cases,  the  velocity  of  a  body  is  a  function  of  the  Generalized  Coordinates  and  the 
Generalized  Speeds  which  are  implicit  fiinctions  of  time.  The  velocity  partial  derivatives 
and  the  angular  velocity  partial  derivatives  are  obtained  by  taking  the  derivatives  of  the 
velocity  and  angular  velocity  vectors  respect  to  each  Generalized  Speed.  It  will  be  shown 
that  the  velocity  partials  and  the  angular  velocity  partials  are  simply  the  coefficients  of  the 
Generalized  Speeds  in  the  expressions  for  the  velocity  and  angular  velocity  vectors. 
Example  2  illustrates  how  to  determine  the  velocity  partials  and  angular  velocity  partials  for 
a  simple  system  as  shown  in  Figure  1. 

Example  2  -  Determine  the  velocity  and  angular  velocity  partials  for  the  system  shown  in 
Figure  1.  Solution : 

i  -  Define  the  Generalized  Coordinates  -  In  order  to  describe  the  system,  two  Generalized 
Coordinates  are  required  since  the  system  has  two  degrees  of  freedom.  One  possible 
choice  is  to  use  the  angle  between  each  link  and  the  positive  X  axis 

qi  =  ei    &  q2  =  e2 

ii  -  Define  the  Generalized  Speeds  -  Two  Generalized  Speeds  are  required,  for  which  there 
are  different  options.  In  this  case  the  two  following  possible  sets  wUl  be  used  for  the 
system 

Set  1  :  uj  =  (01 ;  U2  =  032      Set  2  :  ui  =  toi  ;  U2  =  002  -  toi 
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where  coi  and  W2  are  the  time  derivatives  of  the  Generalized  Coordinates. 

iii  -  Find  an  expression  for  the  velocity  vector  and  angular  velocity  vector  of  each  body  of 
the  system.  These  must  be  a  function  of  the  Generalized  Speeds  and  Coordinates.  The 
velocity  of  each  link  of  the  system  at  a  given  point  must  be  determined.  Point  "a"  will  be 
used  for  link  1  and  point  "b"  will  be  used  for  Unk  2 
For  the  first  set  of  Generalized  Speeds,  the  velocities  can  be  written  as  - 

Vi  =  LiUi  (-sinOi  i +cos0ii);      toi  =  uik 

V  2  =  Li  ui  ( -  sine  1  i  +  cos6 1  j )  +  L2  U2  ( -  sin62  i  +  cos02  j );    w  2  =  u  2  K 
The  velocity  partials  and  angular  velocity  partials  can  now  be  determined 


av  1  d\i^ 
 =  Li  (-sin0i  i  +  cos6i  j) ;    =  0 

6u  1  5u  2 


av?  av2 

=  Li  (-sin6i  i  +  cos6i  j) ;   =  L2(-sin62  i  +  cos02  j) 

au  1  au  2 


5m  1    ,     5toi    _    aco2   ^    5w2  . 

  =  k  ;    =  0  ;    =  0  ;    =  k 

aui  au2  dui  du2 

For  the  second  set  of  Generalized  Speeds,  the  velocities  can  be  written  as  - 

V 1  =  Li  u  1  ( -  sin0 1  i  +  COS0 1  j ) 

V2  =  Li  ui  (-sin0i  i  +  COS01  j)  +  L2  (uj  -  U2)  (-sin02i  +  cos02  j) 


CO  1  =  u  1  k;     W2  =  (ui  -  U2)  k 
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The  velocity  partials  and  angular  velocity  partials  for  this  set  of  Generalized  Speeds  are 


Li  (-sin0i  i  +  COS01  j) ;  =  0 

Li  (-sin0i  i  +  cosSi  j)  +  L2(-sin62i  +  cos02  j  ) 
L2(sin02i-cos02j) 

^.  sj^^^,  aej^j^.  to2_j^ 

du2  5ui  du2 

Note  that  the  velocity  and  angular  velocity  partials  do  not  have  velocity  units.  The 
velocity  partial  derivatives  have  length  units  if  the  Generalized  Speed  is  an  angular  velocity; 
and  are  dimensionless  if  the  Generalized  Speed  is  a  translational  velocity.  The  angular 
velocity  partial  derivatives  are  dimensionless.  The  selection  of  the  set  of  Generalized 
Speeds  will  not  affect  the  final  form  of  the  equations  of  motion.  It  will  determine  the 
amount  of  work  that  the  analyst  has  to  do  in  order  to  set  up  the  dynamic  model.  In  this 
problem  the  first  set  simplifies  the  expressions  for  the  velocity  partials  which  will  also 
simplify  the  amount  of  work  required  to  obtain  the  equations  of  motion.  The  velocity  of 
each  body  can  be  expressed  in  terms  of  the  Generalized  Speeds  and  the  velocity  partials  and 
angular  velocity  partials 

k  =  1  ou  k 

The  velocity  partials  and  the  angular  velocity  partials  can  be  thought  of  as  the  base  vectors 
in  which  the  velocity  of  a  body  is  expressed  in.  They  are  the  directions  in  which  the 
instantaneous  motion  is  taking  place  at  a  given  moment.  If  the  velocity  of  body  j  does  not 
depend  on  the  rth  GenCTalized  Speed,  the  rth  velocity  partial  of  that  body  is  zero. 


avi 

du  1 

d\2 
du  I 

d\2 
d\i2 

5(0  1 
dui 
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3  Resultant  Forces  &  Resultant  Torques 

The  resultant  forces  and  torques  acting  upon  each  body  j  of  the  system  must  be 
determined  in  order  to  obtain  the  equations  of  motion .  It  is  very  important  that  all  the 
forces  acting  on  a  body  be  defined  respect  to  a  common  point  j.  Although  the  point  j  for 
each  body  can  be  arbitrarily  selected,  it  is  more  useful  to  define  this  point  at  the  center  of 
gravity  of  body  j. 

The  resultant  force  and  torque  that  act  upon  body  j  of  the  system  can  be  written  as 
ri  =  Fej  +  Fcj  +  Ffj    &   Tj  =  lej  +  Tcj+lfj 

where  F  ej  and  T  ej  are  the  external  forces  and  torques;  F  cj  and  T  cj  are  the  contact  forces 

and  torques;  and  F  q  and  T  fj  are  the  field  effect  forces  and  torques. 

The  external  forces  and  torques  are  all  the  inputs  to  the  system  that  are  gen^ated  by 
actuators  such  as  motors  and  hydraulic  pistons;  or  by  disturbances  such  as  chattering  in 
milling  and  turning. 

The  contact  or  interaction  forces  are  the  forces  and  torques  that  are  caused  by  the 
interaction  of  body  j  with  other  adjacent  bodies.  These  can  be  divided  into  two  categories: 
workless  constraints  and  contributing  forces.  Noncontributing  or  workless  constraint 
forces  do  not  increase  or  decrease  the  energy  of  the  system  since  they  act  parallel  to 
directions  along  which  there  is  no  motion.  A  typical  case  is  the  normal  force  between  a 
body  and  the  surface.  The  body  is  moving  tangent  to  the  surface  and  the  contact  force  is 
acting  perpendicular  to  the  surface,  a  direction  in  which  there  is  no  motion.  These  forces 
are  also  known  as  reciprocal  forces,  constraint  forces,  or  workless  forces.  Although  they 
can  be  included  in  the  force  expression  without  any  loss  of  generality,  it  is  not  necessary  to 
include  these  forces  (or  torques)  in  the  resultant  force  (or  torque)  expression  because  once 
they  are  multiplied  by  the  velocity  partials  and  angular  velocity  partials  (the  base  vectors  for 
the  body's  motion)  as  required  by  equation  (1)  they  will  be  eliminated. 

The  contributing  interaction  forces  are  generated  between  bodies  that  are  connected  by 
nonrigid  elements  such  as  elastic  springs  and  viscous  dampers.  They  act  along  the 
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direction  of  motion  and  will  change  the  energy  level  of  the  system.  Other  connection  forces 
such  as  those  produced  by  dry  friction  and  nonUnear  elastic  elements  can  also  exist  between 
two  bodies.  The  force  generated  by  these  connections  will  be  a  function  of  the  Generalized 
Coordinates  and/or  the  Generalized  Speeds. 

Field  forces  and  torques  are  those  forces  and  torques  caused  by  the  action  of  a  force 
field  such  as  a  magnetic  force  field  or  a  gravitational  field.  Although  the  gravitational  field 
is  the  most  common  type,  there  are  some  case  in  which  the  magnetic  field  has  a 
considerable  effect  on  a  body  such  as  in  the  case  of  magnetic  bearings.  The  force  or  torque 
generated  by  gravity  is  given  by 

Ffj=-Mjge;       lg=  (-Mjge)  x(rj/cg) 

where  e  is  the  direction  of  the  gravitational  field,  and  r  j/cg  is  the  distance  from  the  center  of 
gravity  to  the  point  of  reference.  The  torque  caused  by  gravity  is  zero  when  the  center  of 
gravity  is  selected  as  the  reference  point 

The  resultant  force  and  torque  acting  on  a  rigid  body  will  be  determined  for  the  system 
of  Example  3. 

Example  3  -  Determine  the  resultant  forces  and  torques  acting  on  the  rigid  body  shown  in 
Figure  2. 

Solution  -  Assume  that  friction  between  the  body  and  the  inclined  plane  is  zero  and  that  all 
forces  intersect  the  center  of  gravity  of  the  rigid  body. 

i  -  Make  a  free  body  diagram  for  the  rigid  body  as  shown  in  Figure  3.  There  all  types  of 
forces  acting  on  the  rigid  body.  There  is  an  external  force  F,  there  is  the  effect  of  gravity, 
there  is  a  workless  constraint  acting  normal  to  the  inclined  plane  and  tho-e  are  contact  forces 
produced  by  the  spring  and  the  damper. 

ii  -  Add  up  all  the  forces  acting  on  the  rigid  body  -  Since  all  the  forces  intersect  the  center  of 
gravity,  the  resultant  torque  is  zero.  To  simpUfy  the  force  analysis,  the  forces  will  be 
added  in  the  t  and  n  directions. 
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Figure  2  -  Example  of  a  system  with  interaction  forces 


Figure  3  -  Free- Body  Diagram  for  example  3 
Forces  in  the  t  direction 

£  F  =  (  F  + W)cos45°t  -(Cx  +  Kx)t 

Forces  in  then  direction 

F  =  Fnn  -(  F  +  W)cos45°n 
where  W  is  the  weight  of  the  mass  M. 
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4  Resultant  Inertial  Forces  and  Resultant  Inertial  Torques 
The  resultant  inertial  force  and  torque  acting  on  body  j  have  are  given  by  as 

Fj  =  -  m  j  A  j   «&  Tj  =  -  a  j  •  Ij  -  Wj  X  Ij  .  coj 

the  acceleration  vector  and  angular  acceleration  vector  of  body  j  at  point  j  must  be 
expressed  as  a  function  of  the  Generalized  Coordinates,  the  Generalized  Speeds  and  their 
time  derivatives.  Once  the  Inertia  Dyadic,  the  acceleration  and  angular  acceleration  vectors 
of  body  j  have  been  detamined  the  resultant  inertial  force  and  torque  can  be  easily 
calculated  using  the  above  equation. 

4.1  Inertia  Dyadic 

The  inertia  dyadic  is  an  alternate  way  of  describing  the  inertia  of  a  body.  This  section 
describes  what  is  a  dyad,  a  dyadic  and  how  these  can  be  used  for  describing  the  inertia  of  a 
rigid  body.  A  dyad  is  an  operator  that  is  formed  by  the  juxtaposition  of  any  given  number 
of  vectors.  As  an  example,  given  vectors  A  and  B,  the  dyad  A  B  is  defined  as 


Ax 

Ax 

Bx 

Ay 

&  B  = 

By 

the  dyad  AB  = 

Ay 

By 

Az 

Bz 

Az 

Bz 

Note  that  the  dyad  is  neither  a  scalar  product  nor  a  vector  product  of  the  vectors  involved, 
these  vectors  are  just  grouped  together.  One  of  the  properties  of  a  dyad  is  that  when  the 
scalar  product  of  a  dyad  A  B  and  a  vector  u  is  taken,  another  vector  is  always  obtained. 
The  resultant  vector  depends  of  the  order  of  the  multiplication 

y=u»AB  ;  w=AB»u     where  y  w 
A  dyadic,  Q",  is  a  sum  of  dyads 


Q"  =  AB  +  CD  +  EF 
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The  iriCTtia  of  a  rigid  body  can  be  described  by  using  an  inertia  matrix  or  tensor  [11.  This  is 
defined  respect  to  a  set  of  mutually  perpendicular  axes  (such  as  n  i,  n  2  &  n  3  of  Figure  4) 


(Il23)  = 


^11  hi  ^13 
hi  h.2  h3 
1^1  hi  h3, 


One  of  the  limitations  of  using  the  inertia  matrix  [1 123]  is  that  it  must  be  rederived  if  the 
inertia  of  the  body  is  to  be  described  with  respect  to  another  set  of  axes  (such  as  n  a,  n  b  & 
n  c  of  Figure  4).  A  better  way  to  describe  the  inertial  properties  of  a  rigid  body  is  by  using 
the  inertia  dyadic  I".  The  dyadic  I"  can  be  defined  in  terms  of  the  inertia  matrix  of  the  rigid 
body,  [1 123]  (which  is  defined  in  terms  of  the  axes  n  1,  n  2  «fe  n  3) ,  and  the  axes  n  1,  a  2  & 

a3 

r=  Ii  ni  +I2n2  +  l3n3  (51) 
where  Ii,l2«&l3arethe  columns  of  the  inertia  matrix  [1 123]-  This  can  also  be  written  as 


In 

nix 

I12 

'  n2x  ' 

Il3 

n3x  " 

I"  = 

1 21 

nl  y 

+ 

1 22 

n2y 

+ 

1 23 

n3y 

L  I31  J 

nlz 

1 32 

n2z 

-  I33  - 

n3z  . 

The  inertia  dyadic  can  be  used  to  determine  the  elements  of  the  inertia  matrix,  [I  abc]» 
defined  with  respect  to  any  set  of  axes  (such  as  n  a,  n  b  &  B  c  in  figure  3) 

[Iabc]  =  [na«  r,nb«  r,nc.  T] 

This  can  be  also  written  as 

Ia=   Ha*  r=  Ha*  IlHi  +  na«  12112  + ELa*  13113 


Ib=  nb»  1"=  lib*  Iini+llb'  I2n2  +  nb»  I3!13 
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Figure  4  -  Different  sets  of  reference  axes 

Ic=  Die*  r=  He*  Iini  +  nc»  I2fl2"''flc*  13113 

where  Ia,Ib&Icarethe  columns  of  the  inertia  matrix  [I  abcl- 

A  simple  way  to  determine  the  inertia  dyadic  of  a  rigid  body  is  by  using  the  moment  of 
inertia  about  the  principal  axes  of  the  body 

I''j=  Ixxllxllx  +  lyy  Hylly  +  Izzfizflz 

where  I  xx » I  yy  &  I  zz  are  the  principal  moments  of  inertia;  and  n  x  ,  n  y  and  n  z  are  unit 

vectors  describing  the  orientation  of  the  principal  axes  of  the  rigid  body.  The  inertia  dyadic 
for  body  j  in  terms  of  the  principal  axes  can  also  be  written  in  its  expanded  form  as 


"  nxx 

nxx 

nyx  " 

nyx 

nzx 

nzx 

I"   -  T 
*  J  -  ixx 

nxy 

nxy 

+  lyy 

nyy 

nyy 

+  Izz 

nzy 

nzy 

nxz 

.  nxz 

_  nyz 

nzz 

nzz 
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Although  the  Inertia  Dyadic  is  independent  of  the  orientation  of  coordinate  frame,  it 
depends  on  the  location  of  the  origin  of  the  coordinate  frame  in  a  similar  way  as  the  inertia 
tensor.  The  Theorem  of  Parallel  Axes,  which  is  used  to  determine  the  inertia  tensor  for  any 
origin  location,  also  applies  to  Inertia  Dyadics 

where  Fj/a  is  the  Inertia  Dyadic  of  body  j  about  an  arbitrary  point  a,  Fj/c  is  the  Inertia 

Dyadic  of  body  j  about  its  centCT  of  gravity  c,  and  Fg/c  is  the  change  in  Inertia  Dyadic 

produced  by  the  change  of  reference  point  from  c  to  a.  This  third  term  depends  on  the 
relative  position  vector  of  point  "a"  with  respect  to  c,  and  on  the  mass  of  body  j. 

Example  4  -  Using  the  concept  of  Inertia  Dyadic,  determine  the  inertia  matrix  for  the  body 
shown  in  Figure  5  respect  to  the  XYZ  frame.  The  principal  moments  of  inatia  are  given 
by  (for  a  thin  disk) 

Izz  =  0.5mR2;  Ixx  =  Iyy  =  0.25mR2 


Figure  5  -  System  for  Example  4 
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The  orientation  of  the  rigid  body  is  described  by  the  unit  vectors  n  i,  n  2  and  n  3 


0.866^ 

-0.353  ^ 

0.353 

"1  = 

0.50 

SL2  = 

0.612 

as  = 

-0.612 

-   0  s 

-  0.707  - 

-  0.707  - 

The  principal  axes  and  moments  of  inertia  will  be  used  to  determine  the  Inertia  Dyadic  for 
this  body 


0.866^ 

0.866 

"  -  0.353 

-  0.353 

0.353 

0.353 

1"  =     I XX 

0.50 

0.50 

+  lyy 

0.612 

0.612 

+  Izz 

-0.612 

-0.612 

-    0  ^ 

-   0  - 

-  0.707 

^  0.707  - 

-  0.707  - 

-  0.707  - 

The  inertia  matrix  or  tensor  respect  to  the  XYZ  frame  can  be  determined  by  using  the 
following  equation 

[i]  =  [x  •  r,  Y  .  r,z  •  F] 


Each  column  of  the  inertia  matrix  or  tensor  is  given  by 


X 

•  I"  = 

I  XX 

1 

0 

.  0- 

•[niltai] 

+  lyy 

I  " 
0 

-  0- 

•[n2][n2] 

+  Izz 

1 

0 

-  0- 

•[n3][n3]| 

Y 

Ixx 

0 

1 

-  0. 

•[ni  ][ni] 

+  lyy 

0 
1 

-  0- 

•[n2][n2] 

+  Izz 

0 

1 

-  0- 

•[a3][n3]| 

Z 

•  I"  = 

I  XX 

0 
0 

- 1  - 

•[ni][ni] 

+  lyy 

0 

0 

- 1  - 

•[n2][n2] 

+  Izz 

0 
0 

- 1  - 

•[a3][a3]  J 

Substituting  the  values  of  the  moments  of  inertia  and  the  unit  vectors  n  1,  n  2  and  n  3,  the 
inertia  tensor  respect  to  the  XYZ  frame  is 
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[I]  =  mR2 


0.281  -0.0514  0.0625 
-0.0514  0.344  -  0.108 
0.0625  -0.108  0.375 


The  following  example  shows  how  to  determine  the  inertial  forces  and  torques,  using 
the  definition  given  before  and  the  Inertia  Dyadic. 

Example  5  -  Determine  the  inertial  forces  and  torques  acting  on  each  link  in  Figure  1 
Solution 

i  -  First  determine  the  acceleration  and  angular  acceleration  vectors  for  both  links.  These 
can  be  found  by  taking  the  time  derivative  of  the  velocity  and  angular  velocity  vectors 
which  were  found  in  example  2 


V  1  =  Li  u  1  ( -  sinOi  i  +  cosOi  j) 


V2  =  Li  ui  (-sinOi  i  +  cosBi  j)  +     "2  (-sin62  i  +  cos02  j) 

wi  =  uik;  W2=U2k 

The  accelerations  and  angular  accelerations  for  bodies  1  and  2  are 
Acceleration  of  Body  1  at  point  a,  and  the  angular  acceleration  of  Body  1 

A 1  =  Li  ^  (-sinOi  i  +  cos9i  j  )  +  Li  ui  (Oi  (-cosOi  1  -  sinOi  j ) 
dt 

Acceleration  of  Body  2  at  point  b,  and  the  angular  acceleration  of  Body  2 

A  2  =  A  1  +  L2  ~^  (-sin02  i  +  COS62  j )  +  L2  U2  CO2  (-COS02 1  -  sin92  j ) 
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ii  -  Using  the  fact  that  the  Generalized  Speeds  u  i  and  u  2  are  the  angular  velocity  of  links  1 
and  2  respectively,  the  resultant  inertial  forces  calculated  by  using  the  expressions  derived 
above  are 

V\  =  Ml  Li  a  1  (sin6i  i  -  cosSi  j)  +  MiLi  Wi^  (cos6i  i  +  sin6i  j ) 

F*2  =  -  M2  A  1  +  M2  L2  a  2  (sin62  i  -  cos02  j )  +  M2  L2  002^  (cos02  i  +  sin02  j ) 

iii  -  In  the  planar  case  the  angular  velocity  and  acceleration  vectors  are  perpendicular  to  the 
plane.  The  unit  vectors  n  1  and  n  2  are  in  the  plane  and  the  unit  vector  n  3  is  perpendicular 

to  the  plane.  Therefore  the  following  scalar  and  vector  products  are  zero 

otj  -Ini]  =  ttj  -[112]  =  Wj  •[nil  =  Wj  •[n2l  =  toj  x[n3]=0 

The  first  term  of  both  inertial  torques  can  be  simplified  to 

aj  •  Ij"  =  Ixx  ttj  •[ni][ni]  +Iyy      •  [n2][n2l  +  Izz  aj  •  [n3][n3]  =  Izztt j k 
The  second  term  of  each  inertial  torque  can  be  simplified  to 

ajjxij"  -coj  =  Ixx  mj'<[ni][ni]  •  w j  +Iyy  Wjx[n2][n2]  + 

Izz  Wj'<[n3][  113] '02^  =  0 
Therefore  the  resultant  inertial  torques  for  links  1  and  2  are  - 

1*  =  -a  ilzik    &  T2  =  -a2lz2k 


6  Steps  for  using  Kane's  Method 

In  order  to  derive  the  dynamic  model  of  a  system  using  Kane's  Method,  the  following 
steps  must  be  completed 

1  -  Determine  the  degrees  of  freedom  of  the  system  to  be  analyzed,  n 

2  -  Select  the  Generalized  Coordinates  (must  be  an  independent  set  which  has  n  terms) 

3  -  Define  the  n  Generalized  Speeds  for  the  system.  These  must  functions  of  the 
Generalized  Coordinates  and  their  first  time  derivatives. 

4  -  Write  expressions  for  the  velocity,  angular  velocity,  acceleration  and  angular 
acceleration  of  each  body  in  the  system  in  terms  of  the  n  Generalized  Coordinates  and  the  n 
Generalized  Speeds  defined  in  steps  2  and  3. 

5  -  Obtain  the  velocity  partials  and  angular  velocity  partials  of  the  equations  from  step  4. 

6  -  Obtain  the  resultant  force  and  torque  acting  on  each  body. 

7  -  Calculate  the  resultant  inertial  force  and  torque  acting  on  each  body. 

8  -  Setup  the  n  equations  of  motion  using  equation  ( 1) 

These  steps  will  be  used  in  the  examples  that  follow. 

Example  6  -  Obtain  the  dynamic  model  for  the  system  shown  in  figure  6  using  the  steps 
ouflined  above. 

stqp  1  -  The  system  has  one  degree  of  freedom. 

step  2  -  The  displacement  of  mass  M,  x,  will  be  used  as  the  Generalized  Coordinate, 
step  3  -  The  first  time  derivative  of  x  will  be  used  as  the  Generalized  Speed. 

qi  =  x      &      ui  =  ^ 

step  4  -  The  angular  velocity  and  angular  acceleration  are  zero  since  the  system  only  has 
translational  motion.  The  velocity  and  acceleration  for  the  mass  M  are  given  by 


^  dt 
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frictionless 
^  rigid  contact 


Figure  6  -  System  for  example  6 

step  5  -  The  angular  velocity  partial  is  zero  since  the  angular  velocity  is  zero.  The  velocity 
partial  derivative  with  respect  to  the  Generalized  Speed  is 

^  =  i         ^  =  0 

step  6  -  The  resultant  torque  for  this  system  is  zero  since  all  the  forces  are  assumed  to  go 
through  the  center  of  gravity  of  the  mass.  The  resultant  force  acting  on  the  body  is  given 
by 

Fi  =  Fcos(55^i-Kxi-C^^i +  Fsin(55°)j +Fnj     ;  Ti=0 

step  7  -  The  resultant  inertial  torque  for  this  system  is  zero  since  the  angular  acceleration  is 
zero.  The  resultant  inertial  force  acting  on  the  body  is  given  by 

dt2 

step  8  -  The  equation  of  motion  is  given  by  equation  (1) 

^(z,-e;)=o 


Using  the  expressions  for  the  velocity  partial  derivative,  the  resultant  force  and  the  inertial 


fOTce  derived  in  previous  steps  the  equation  of  motion  can  be  written  as 
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1  • 


(f  cos(55°)  i  -  Kx  i  -  C       +  F  sin(55°)  j  +  Fn  j  )  -  i 

V  dt  '  Ht2 


dt "  I  dt^ 

The  equation  of  motion  can  be  simplified  to 


0.5735F  =  Md^  +         +  Kx 
dt2  dt 


Notice  that  the  workless  contact  force,  Fn,  is  eliminated  from  the  equation  once  the  scalar 
product  is  taken  with  the  velocity  partial  derivative  (which  define  the  directions  of  motion). 
For  this  example,  the  equation  could  be  obtained  with  less  effort  using  Newton's  2nd  Law. 
For  more  complicated  problems,  Kane's  Method  is  more  efficient  for  setting  up  the 
dynamic  model. 

Example  7  -  Obtain  the  dynamic  model  for  the  system  shown  in  figure  7 
For  simplicity,  the  unit  vectors  i  and  n  will  be  used  to  describe  the  forces  and  motion, 
step  1  -  Detamine  the  degrees  of  freedom  of  the  system:  By  inspection  it  can  be  seen  that 
this  system  has  two  degrees  of  freedom. 

stq)  2  -  Select  the  Generalized  Coordinates :  The  displacements  Xa  and  Xb  will  be  used  as 
the  Gaieralized  Coordinates.  These  are  sufficient  to  locate  all  the  parts  of  the  system. 

qi=Xa     &      q2  =  Xb 

step  3  -  Define  the  n  Generalized  Speeds  for  the  system:  The  following  set  of  Generalized 
Speeds  will  be  used  - 

„.  -dXa  .     _dXb    dXa        *      ^     .  ^ 
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Figure  7  -  An  inclined  2  DOF  system 


step  4  -  The  angular  velocities  and  angular  accelerations  are  zero  there  is  only  translational 
motion.  The  velocities  and  accelerations  for  the  masses  Ma  &  Mb  are  given  by 

Ya=uit  ;  Yb  =  u2t  +  uit;  Aa  =  ^t  ;  Ab  =  ^t+^1 

step  5  -  Obtain  the  velocity  partial  derivatives  and  the  angular  velocity  partial  derivatives 

5u  1  5u  2  1  5u  2 

step  6  -  Obtain  the  resultant  force  and  torque  acting  on  each  body:  Only  the  resultant  forces 
will  be  determined  since  there  are  no  torques  acting  upon  the  system.  There  are 
contributing  interaction  forces  generated  by  the  springs  and  viscous  dampers  acting  on  the 
system,  a  workless  constraint  from  the  contact  of  the  bodies  with  the  inclined  plane,  an 
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extonal  force  acting  on  M  b  and  the  gravitational  field  acting  on  both  bodies. 

The  forces  acting  on  body  "a"  are 
external  forces:      F  ea  =  0 

contact  forces:        Fca=CbU2t  -CaUit  +  Kb(Xb-Xa)t  -KaXat  +  Fnall 
field  forces:  F  fa  =  0.707  M  a  g  t  -  0.707  M  a  g  n 

The  resultant  force  acting  of  body  "a"  is 

Fa  =  0.707Mag(t  -n)+CbU2t  -CaUit  +Kb(Xb-Xa)t  -KaXat  +  Fnan 

The  forces  acting  on  body  "b"  are 
extCTnal  forces:      F  eb  =  F  t 

contact  forces:       Fcb  =  -CbU2t  -  Kb  (Xb- Xa)  t  +  Fnbfl 
field  forces:         Ffb  =  0.707Mb  gt  -  0.707Mb  gn 
The  resultant  force  acting  of  body  "b"  is 

Fb  =  Ft  +  0.707Mbgt  -0.707Mbgn-CbU2t  -Kb(Xb-Xa)t  +Fnbn 

where  F  na  and  F  nb  are  the  workless  contact  forces  between  each  body  and  the  inclined 
plane. 

step  7  -  Obtain  the  resultant  inertial  forces  and  torques:  The  resultant  inertial  torques  are 
zero  since  the  system  only  has  translational  motion  (angular  velocities  and  accelerations  are 
zero). 

The  resultant  inertial  force  acting  of  body  "a"  and  body  "b"  are 

' ' '  ^-  -  ■  . 

F*a=AaMa=^  Mat  =  XaMat 
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step  8  -  Setup  the  equations  of  motion  using  (1) 

for  the  first  Generalized  Coordinate  and  second  Generalized  Coordinates 

'^(F.-r.)-'^(Eb-F;)=o 

dui  dui 

^(F,-E-J*'^(Fb-r;)=o 

d\i2 

The  first  term  of  the  first  equation  of  motion  can  be  written  as 

^(ra-r*a)  =t-[CbU2t  +  Kb(Xa-Xb)t-CaUit-KaXat]  + 
dVL  1 

t-[0.707Magt- 0.707  Magn  +  Fnall-XaMat] 
The  second  term  of  the  first  equation  of  motion  can  be  written  as 


avb 


(Fb-Eb)  =  t'lFt  -CbU2t-Kb(Xa-Xb)t  +  Fnbn]  + 


l-[0.707Mbgt-0.707Mbgn  -XbMbt] 

The  first  equation  of  motion  is  obtained  by  simplifying  both  terms  and  grouping 

F  =  (Xb-0.707g)Mb  +  (Xa-0.707g)Ma  +  CaUi  +KaXa 

The  first  term  of  the  second  equation  of  motion  is  zero  since  the  velocity  partial  derivative  is 
zero.  The  second  term  of  this  second  equation  of  motion  is 


aVb 


(ib-Eb)  =  t-[Ft  -CbU2t-Kb(Xa-Xb)t  +  Fnbn] 


t •[ 0. 707 Mbg t- 0.707 Mb gn  -XbMbt] 
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Simplifying,  the  second  equation  of  motion  can  be  written  as 

F  =  (Xb-0.707g)Mb  +  CbU2+Kb(Xa-Xb) 

Note  -  The  workless  constraint  forces  F  na  and  F  nb  are  eliminated  by  the  scalar  product  of 
the  velocity  partials.  Therefore  Kane's  Method  provides  a  sure  way  to  eliminate  workless 
constraints  that  other  method  such  as  Lagrange  do  not. 
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